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ABSTRACT 


A teleoperator system consists of a manual controller, control hard- 
ware/software, and a remote manipulator. It has been employed in either haz- 
ardous or unstructured, and/or remote environments (space applications, under- 
sea operations, mining, nuclear reactor maintenance, etc.). In teleoperation, the 
“man-in-the-loop” is the central concept that brings human intelligence to the 
teleoperator system. When teleoperation involves contact with an uncertain 
environment, providing the feeling of “telepresence” to the human operator is 
one of desired characteristics of the teleoperator system. Unfortunately, most 
available manual controllers in bilateral or force-reflecting teleoperator systems 
can be characterized by their bulky size, high costs, or lack of smoothness and 
transparency, and elementary architectures. 

To investigate other alternatives, a force- reflecting, 3 degree of freedom 
(dof) spherical manual controller is designed, analyzed, and implemented as a 
test bed demonstration in this research effort. To achieve an improved level of 
design to meet criteria such as compactness, portability (light weight), and a 
somewhat enhanced force-reflecting capability, the demonstration manual con- 
troller employs high gear-ratio reducers. To reduce the effects of the inertia and 
friction on the system, various force control strategies are applied and their per- 
formance investigated. The spherical manual controller uses a parallel geometry 
to minimize inertial ana gravitational effects on its primary task of transparent 
information transfer. 

As an alternative to the spherical 3-dof manual controller, a new con- 
ceptual hybrid (or parallel) spherical 3-dof module is introduced with a full 
kinematic analysis. Also, the resulting kinematic properties are compared to 
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those of other typical spherical 3-dof systems. The conceptual design of a par- 
allel 6-dof manual controller and its kinematic analysis is presented. This 6-dof 
manual controller is similar to the Stewart Platform with the actuators located 
on the base to minimize the dynamic effects. Finally, a combination of the 
new 3-dof and 6-dof concepts is presented as a feasible test-bed for enhanced 
performance in a 9-dof system. 
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CHAPTER 1 


Introduction 


A human’s continuous desire to extend his/her vulnerable physical ca- 
pabilities has been shown in the development of various mechanisms such as the 
automobile, the space shuttle, robots, etc. As machines become more complex 
and increasingly self-contained in decision-making capability, the temptation is 
to assume that they are autonomous. 

In fact, what we can surely suggest is that human intervention will be 
less frequent but, when it is required, it will occur at a higher level and therefore 
require a better interface (visual, kinesthetic, voice-activated, etc.). Currently, 
only simple, repetitive tasks can be performed autonomously, without human 
intervention; almost all unstructured, unpredictable and complex tasks require 
some human guidance and intelligence. Hence, as system technology develops, 
there will be a greater need for man-machine interfaces- not less. The man- 
machine interface has been developed as a natural step in the evolution towards 
autonomous systems. 

The “man-in-the-loop” is the central concept of teleoperation. The 
essential role of the teleoperation is to increase the level of “telepresence” to the 
point where the human operator perceives the artificial interface environment as 
if it were the real environment; a “transparent” interface must exist to maximize 
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humans 1 limited sensing and communicative capabilities. 


1-1 Teleoperator systems 


A teleoperator system consists of a manual controller, control hard- 
ware/software, and a remote manipulator. In teleoperation, interactions among 
a human operator, a teleoperator system, and the task environment are involved. 
The main function of the teleoperator system is to assist the human operator 
in performing complex, uncertain tasks in hostile/remote environments (under- 
sea, space, nuclear reactors, mining, etc.). The schematic information flow of 
teleoperator systems can be described as in Figure 1-1. 


Manual Controller 
System 


Man-Machine 
Interface System 


Remote Manipulator 
System 



Figure 1-1 Information flow for teleoperator systems 

In teleoperation, while a human can provide intelligence for the system, 
the relatively limited capabilities of his/her input-output channels represent the 
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“bottleneck” of the whole process in Figure 1-2 (adapted from [88]). Human 
input can be aural, visual, tactile, kinesthetic, olfactory, or gustatory (sense of 
taste) and human output can be either muscular or vocal. Muscular output 
can be categorized as locomotional, as in applying force to a manual controller; 
electrical, as measured by a myoelectric electrode; or positional, as in the mo- 
tion tracking of an eyeball. Among those human input-output channels; visual, 
tactile and kinesthetic channels (for input), and muscular channels (for output) 
are extensively utilized in typical teleoperation (physical manipulation). 

To fully utilize these limited input-output channels of a human operator 
or to enhance the performance of teleoperator systems, these systems must be 
designed, integrated and controlled properly to provide a realistic feeling of 
“telepresence” to a human operator. 

More specifically, in the design and control of the teleoperator system, 
the manual controller, the remote manipulator and their control strategies must 
have characteristics which are suitable to their allocated tasks: human factors 
and task parameters. Only the most useful sensory information such as reflecting 
forces, visual information, etc., needs to be provided as long as it does not con- 
fuse and distract the operator. Note, however, that when teleoperation involves 
contact with an unknown environment, a more realistic feel can be provided 
back to the human operator by directly reflecting the contact force information 
on the manual controller through its actuators than that limited awareness that 
can be provided by visual feedback information displayed on a screen. Also 
machine intelligence must be included to aid the operator in performing tasks 
effectively if it can be done reliably. Machine intelligence can be included in 
various forms as described by Sheridan and Verplank[82]; 
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Figure 1-2 The bottleneck of operation (Adapted from Lipkin and Tesar [87]). 
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• Extend: the system’s capabilities are extended by using the computational 
base in concert with the operator (such as filtering to remove the undesired 
jitters and jerks, accomodation to reduce the undesired excessive contact 
forces, etc). 

• Relieve: the machine intelligence can be used to autonomously perform 
functions which would otherwise distract the attention of the operator. 

• Back up: operator misconceptions can be corrected by the machine intel- 
ligence. 

• Replace: repetitive tasks can be autonomously performed in order to al- 
leviate the operator’s mental and physical fatigue. 

As mentioned previously, achieving the feel of “telepresence” is re- 
garded as one of the desired characteristics of the teleoperator system to en- 
hance its performance. Ideally, it could be achieved if either the bilateral or 
the force-reflecting teleoperator system has no time lag or dynamics between 
equivalent position and force parameters in the manual controller and the re- 
mote manipulator. In other words, the system should behave like two massless 
systems connected by a i infinitely stiff (rigid) mechanical linkage [38]. In prac- 
tical implementation, however, achieving that ideal behavior is very difficult due 
to the following limitions: inaccurate system models, nonlinearities (i.e., back- 
lash, friction), communication lag, sensor noise and finite resolution, non-rigid 
structures, finite actuator power output, etc. 

In this work, the design and control of the teleoperator system consist- 
ing of only the kinesthetic information transfer will be studied. No other effects 
of sensory feedback information such as visual and vocal will be discussed. 
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1—2 Objectives of the current research 

One of desired objectives in teleoperator systems is to establish a trans- 
parent, universal interface between and man and machine. However, most avail- 
able manual controllers in bilateral or force-reflecting teleoperator systems can 
be characterized by their bulky size, high costs, or lack of smoothness and trans- 
parency, and elementary architecture. The objective of this work is to investigate 
on the alternative design and control of compact, light-weight manual controllers 
with a somewhat improved force-reflecting capability. 

In this work, the design and control of a low-cost, universal bilateral 
portable manual controller and the value of parallel geometry in a manual con- 
troller is investigated via actual implementation and demonstration. 

To meet or support desired design criteria (i.e., compactness, light- 
weight, and portability), various force control strategies are investigated for a 
force- controlled force-reflecting manual controller application through a proof- 
of-principle one-dof force-reflecting manual controller system which employs a 
high gear-ratio reducer. Then a force- controlled parallel spherical force- reflecting 
3-dof system (called shoulder) is implemented as a demonstration test-bed. 

As another alternative for the design of the manual controller, a concep- 
tual 3- dof spherical gimbal module is introduced and analyzed. For comparative 
purposes, the geometric properties of three different spherical system (i.e., serial 
structure, hybrid structure, and parallel structure) are investigated. Also for 
the design of general 6-dof force- reflecting manual controllers, various parallel 
Stewart Platforms are conceptualized. Kinematic analysis for one of concep- 
tual 6-dof manual controllers, a three-legged Stewart Platform which uses the 
conceptual gimbal modules as its 2-dof actuator modules, is presented and the 
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framework for investigating its geometric properties is presented with the pre- 
liminary results. 

The contents of each chapter are summarized as follows; 

In chapter 1, the concept of teleoperator systems is described first. 
Then the scope of this work is outlined. 

In chapter 2, recent developments on bilateral or force- reflecting control 
strategies are reviewed in detail, including various force control strategies and 
their stability issues. The design and control aspects in teleoperator systems are 
presented. 

In chapter 3, the general background on teleoperator systems is pro- 
vided. The historical review on implementations of the teleoperator systems 
is presented first. The currently available control strategies and software func- 
tions for teleoperator system are briefly reviewed. Also classifications of the 
manual controller and the major teleoperator system evaluation techniques are 
also briefly described. Finally, various manual controllers are compared for their 
performance properties. 

In chaper 4, the kinematic analysis for the parallel spherical 3-dof sys- 
tem(called shoulder) is presented. It includes reverse position analysis and for- 
ward position analysis. The first-order kinematic influence coefficient(KIC) are 
found using the methods of transfer of generalized coordinates [31] [32]. Then the 
design methods using the first-order kinematic influence coefficient formulation 
are presented. 

In chapter 5, force control strategies for a manual controller applica- 
tion are investigated via a one-dof system implementation. A linear model of 
a one-dof system is derived and analyzed to examine the effects of the system 
parameters in force control on the stability of the system. In acutal implemen- 
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tation, two different non-collocated force sensing methods (digital F/T sensor 
mounted on the wrist and analog strain gauge attached on the shaft of the gear 
reducers) are applied and their results are discussed. Then the actual hardware 
implementations for a parallel spherical 3-dof manual controller is presented. To 
reduce the inertia and friction of the system, this module employs the simple 
force control strategy using wrist F/T sensor. Summaries on the system hard- 
ware, control software, the F/T sensor interfacing, and design of the encoder’s 
counter circuits, etc., are given. 

In chapter 6, a new conceptual spherical 3-dof gimbal module is intro- 
duced and its kinematic analysis is presented. Then, kinematic characteristics 
are investigated via the first-order KIC’s and compared to equivalent spherical 
systems with either the serial structure or the parallel structure. 

In chapter 7, various 6-dof manual controllers with parallel structure 
are investigated. A parallel force- reflecting 9-string 6-dof manual controller is 
described briefly first. This system has been implemented by the University 
of Texas Robotics Research Group and interfaced with the Cincinnati Milacron 
T 3 726 industrial robot. Then various conceptual manual controllers with paral- 
lel structure, which basically utilize the Stewart platform structure and modified 
parallel 2-dof conceptual gimbals, are introduced. In particular, a parallel 6-dof 
Stewart Platform with 3 legs seems to satisfy most desired design criteria such 
as compactness, light-weight, etc. Its kinematic analysis is presented. 

In chapter 8, conclusions, recommendations and future work on the 
design and control of the manual controller are discussed. 



CHAPTER 2 


Issues in Current Control and Design of Teleoperator Systems 


2—1 Current issues on control strategies of teleoperator systems 

The development of control strategies for teleoperator systems has been 
relatively slow, limiting the number of strategies currently available. Actually, 
there have been no major advancements since 1948, when Goertz mechanically 
implemented a bilateral control strategy. Bejczy et al. generalized the direct 
joint- to- joint force-reflecting control by utilizing control variables with respect to 
the universal hand frame via appropriate kinematic transformations [10]. Bilat- 
eral control or force- reflecting control, in which the master controller is electroni- 
cally coupled to the slave manipulator, is still the state-of-the-art in teleoperator 
system control. Most of the bilateral control and the force-reflecting control in 
use utilize the servo feedback control which neglects the effects of system dynam- 
ics completely. These neglected dynamics due to inertia, varying load, nonlinear 
friction, backlash, etc., decrease the performance of teleoperation systems. 

Miyazaki et. al. recently proposed the bilateral servo controller and the 
hybrid controller for a master-slave teleoperator system based on the Liapunov 
stability theory[71]. Their hybrid control scheme uses sensory information to 
guide and/or modify the human operator’s command, noting that most of the 
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current motion- based bilateral control schemes completely depend on the op- 
erator’s performance. Furuta et. al. proposed the Variable Internal Model 
Following control scheme which forces teleoperator systems to follow a refer- 
ence model which accepts both the operator’s input force and the contact force 
as a command force to the teleoperator system[34]. In their control scheme, a 
reference model describes a relation between the motion of a master and that 
of a slave. Fong et al. used local microprocessors in teleoperation either to 
expedite real time operation by avoiding unnecessary time-lags or to utilize 
semi-autonomous control, which uses sensory information to modify its motion 
autonomously when it is necessary (concept of “smart” end effectors, etc.)[30]. 

Those above mentioned control strategies do not take into account dy- 
namic interactions among the teleoperator, human operator and task environ- 
ment. However, for the human dynamic models, a tremendous effort was made 
to understand the adaptive, versatile capabilities of humans[57][106j. Most of 
the early research focused on a pilot’s behavior in aircraft control systems. It 
resulted in two representative approaches toward human modeling-the algorith- 
mic model and the structural model [70]. Algorithmic models attempt only to 
mimic the total input-output behavior by estimating the characteristics of the 
human operator. Structural models attempt to find a series of transfer functions 
which describe the human system, thus accounting for many human subsystem 
aspects. However, the human adaptive, versatile behavior seems extremely dif- 
ficult to characterize and requires further research. 

For the bilateral or force-reflecting teleoperator system, Raju et al. 
presented the methodology for designing a bilateral controller using a two-port 
impedance network linear model of a one-dof teleoperator system[77]. Their 
primary objective is to identify the optimal port impedance relations between 
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the human port and the environment port for better performance in teleoper- 
ation, recognizing that the human changes his/her arm impedance consistently 
to match different task requirements. Their stability analysis is based on the re- 
quired specifications of desired port impedances. Hannaford experimented with 
the hard contact behavior of teleoperator systems using a one-dof system[39]. 
Later he presented the hybrid two-port representation to model the bilateral 
teleoperator system and also proposed the bilateral-impedance control which 
requires the estimator to identify the impedances of the human operator and 
of the task environment on-line[40]. However, estimating the task impedances 
is not easy and requires further investigation. The bilateral impedance-control 
has an architecture in which a local servo loop enforces a commanded force and 
impedance. However, it should be noted that these port-based linear models are 
based on the linearity of the system, so it only can characterize the teleoperator 
system around the operating point. For actual multi-dof teleoperator system, 
these approaches need more study before actual application. 

Different from other robotic system applications, teleoperator systems 
contain various sources of time delay in their operations. The main source of 
time delay can be described by: 

• physical distance between the manual controller and the remote manipu- 
lator, 

• the cognitive reaction time of the human operator, 

• the neuromuscular time delays and lags of the human operator, 

• actuator and sensor dynamics of teleoperator systems, 


• intensive computation time requirements. 
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These time delays drastically deteriorate the performance of the teleoperator 
system. How to minimize/reduce the effects of time delay is regarded as one of 
the major problem in teleoperator system control. In bilateral or force-reflecting 
control, when communication time delay is significant such as in deep-sea op- 
erations or in space operations, the operator’s excessive motion command to 
the remote manipulator without synchronized reflecting force information could 
cause excessive contact forces on the remote manipulator and may result in the 
instability of the system. 

In the 1960's, Sheridan and Ferrel showed that the most reliable solu- 
tion for the time delay is to move the manual controller and wait for feedback 
before taking the next step[27] [8 1 ] . Vertut et al.[94] experimented with force- 
reflecting systems with time delay, and found that only with the severely reduced 
bandwidth of the system could a stable response be obtained, allowing veloci- 
ties of only 10 cm/ sec. Recently, Anderson et al. proposed a control scheme to 
cope with the time delay. Their control law maintains passivities between the 
master and the slave system to keep the closed loop system stable[6] [8] . Chapel 
viewed the force- reflecting control of the teleoperator system to be analogous 
to the impedance control of the manipulator and investigated the effects of the 
time delay and the gain scaling on the stability of the system of force-reflecting 
control using a single-axis model[16]. He showed that by the use of local force 
feedback, significant improvements to the stability of the system, could be made 
compared with the conventional bilateral servo feedback controlled manipulator, 
even without a precise model of the system and parameteric knowledge of the 
contact environment. 

Currently, most industrial manipulators use push buttons/swdtch boxes 
to teach the manipulator paths. When the manipulator involves uncertain con- 
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tact forces (deburring, etc.), a rate control 1 utilizing those push buttons/switch 
boxes is not sufficient to meet the requirements for those tasks. IIirzinger[43] 
suggested methods using a force-torque sensor to generate either the desired 
motion command or the desired force command of the manipulator. The force- 
torque sensor can be mounted either on the end effector of the manipulator 
or located at the remote site. The first method is similar to force control in 
the sense that the human operator senses the external force and provides the 
command force to the manipulator directly. The second may be seen as rate 
control in teleoperation using an isotonic (not movable) joystick. However, it 
also uses the output force of the force sensor (i.e., applied human force) to the 
manipulator as a command force. These strategies could be very effective when 
uncertain contacts with the environment are involved or expected. However, the 
second method may lack the kinesthetic feeling for providing better telepresence 
to the human operator. 

In summary, the current state-of-art controls of teleoperator systems 
are the bilateral control or the force- reflecting control. To increase the feeling of 
“telepresence” or to enhance the performance of teleoperator systems further, 
more attention have been given to the effects of the dynamic interactions of the 
teleoperator system with task environments and a human operator. [77] [39] [40] 
However, those studies are based on the simple linear and/or one-dof model of a 
teleoperator system. It requires further study for actual application. The time 
delay, which is one of the most difficult problem in teleoperation, is treated by 
many researchers. [6] [8] [16] However, their study investigate the stability prob- 
lems not the performance of the teleoperator system and it also requires further 
study to achieve desirable results in teleoperation. 


^ee section 3.2 
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2-2 Force control and its stability 

Since teleoperator systems involve interactions with the human opera- 
tor and the task environment, the force control strategies may need more atten- 
tion and need to be better understood to enhance the performance of teleopera- 
tor systems. The following will describe the typical force control strategies and 
their stability issues in robotics applications. There have been many proposed 
force control strategies for manipulators in the literature. A good review on 
force control strategies can be found in [101]. Only a few typical force control 
strategies will be discussed. 



Figure 2-1 Explicit force control (Adapted from [101]) 


Explicit force control in Figure 2-1 has a desired force input and directly 
utilize the sensed forces to generate the control action[101]. In this control, a 
desired force is commanded, rather than position or velocity, and the control 
structure is similar to the proportional motion controller. 

In most industrial manipulators, however, they are commanded along 
some nominal motion trajectory and are based on the servo-control. Therefore, 
most force control strategies utilize the force feedback information to modify 





15 


Nominal 

motion Environment 



Figure 2-2 General architecture of force control (Adapted from [101]) 



Figure 2-3 Stiffness control (Adapted from [101]) 
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the nominal motion trajectory as shown in Figure 2-2. Stiffness control, Damp- 
ing control, and Impedance control, use sensed forces to modify the nominal 
trajectory by regulating the behavior of the end effector of the manipulator in 
specified ways; stiffness, damping, or impedance, respectively[45][46][47][80][99j. 
These classifications are primarily based on how to interpret the force feedback 
data in the feedback loops as can be seen in Figure 2-2. 

For controlling the stiffness of the end effector of the system, two intrin- 
sically different approaches have been suggested. A Remote Center Compliance 
(RCC) device[102] is attached at the end effector of the manipulator and pas- 
sively provides the required compliance (i.e, through elastic deformation of the 
device). The active stiffness control in Figure 2-3 utilizes the force feedback 
information to modify the motion command to actively generate the desired 
stiffness effects at the end effector of the manipulator by specifying and multi- 
plying the compliance matrix, I< F , to the sensed forces, F, accordingly. Note 
that in Figures, K v and K v , represents the position gain and velocity gain ma- 
trices, respectively and that J represents the Jacobian matrix. 

Similar to the stiffness control, the damping control shown in Figure 
2-4 uses the sensed force feedback data to modify the nominal velocity command 
to generate the equivalent damping effect to the system. 

The impedance control in Figure 2-5 can be regarded as a generaliza- 
tion of various force control strategies (i.e., the stiffness control, damping control, 
and force control). It actively regulates the end effector dynamic behavior of the 
manipulator to external forces. The differential equation representing a linear 
second order system (i.e., mass-damper-spring system) is generally used as a 
target impedance of the end effector of the controlled manipulator[98][99][100]. 
In the literature, most proposed impedance controllers assume the decoupling 
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and linearization of the end effector dynamics via non-linear feedback control 
strategies such as computed torque control or its equvalents in operational space, 
noting that the impedance of the manipulator is configuration-dependent and 
highly nonlinear[6][95]. The controlled system is known to be locally stable 
when the target impedance is selected properly [54] [55]. Anderson and Spong 
used the Duality concept between Thevenin and Norton equivalents in network 
theory to contend that the robot must be controlled consistently with respect to 
the environment [7]. They identified the impedance control law, which insures 
that the system could be controlled without steady-state errors, based on the 
Duality condition . 



Figure 2-6 Hybrid control (Adapted from [101]) 


Hybrid control demonstrated by Raibert and Craig[76], as shown in 
Figure 2-6, applies both force control and motion control into two separate 
subspaces, divided by the selection matrix, [S]. The selection matrix is diagonal, 
with ones or zeros corresponding to whether the subspace is to be position 
controlled or force controlled, respectively. The determination of the selection 
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matrix might not be easy for general task environments and it restricts the 
applications of the otherwise promising hybrid control strategies within only 
well structured task environments. 

The force control problem of a manipulator involving contact with a stiff 
environment has been extensively considered in the recent literature[4] [5] [24] [25] 
[26]. In motion control strategies based on only motion feedback data, when the 
manipulator involves contact with a stiff environment, a very high gain posi- 
tion feedback is required to follow the desired commanded motion trajectory. 
However, due to the noise in the motion feedback data, the control action is 
dominated by the noise and may result in an unstable response. For the sys- 
tem with force feedback, since the force feedback represents a very high gain 
position feedback, instability of the system is possible when its gain is increased 
carelessly. These instabilities were observed by previous researchers [97] and can 
be characterized by the end effector bouncing back and forth against a con- 
tacting surface. The possible sources for those instabilities (or contact instabili- 
ties), could be related to the following; environment dynamics, sensor dynamics, 
nonrigid manipulator links, limited bandwidth of the actuator subsystem, im- 
pact energy, nonlinear friction and backlash, etc. Eppinger and Seering used a 
lumped linear system model to identify possible sources for those instabilities 
when a simple proportional force control law is applied [24] [25]. They showed 
that in their lumped linear model, the dynamics existing between the actuator 
and the force sensor is a source for instability in a simple proportional force 
controlled system. An and Hollerback[5] investigated the stability issue caused 
by the interaction of the dynamics of the robot with the dynamics of the en- 
vironment (dynamic stability) using a direct drive arm, and suggested a control 
law utilizing both wrist sensing and open-loop joint torque control to cope with 
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these instabilities. 

There are other types of instabilities caused by kinematic transforma- 
tions in certain Cartesian-based force control implementation: kinematic insta- 
bility introduced by An and Hollerback[4] and kinestetic instability described by 
Lipkin and DufFy[65] in hybrid control. The kinematic instability is primarily 
caused by the interaction of the inertia matrix of the robot with the inverse of 
the Jacobian matrix. The kinestetic instability, referring to the instability as- 
sociated with the decomposition of force and motion feedback signals to ensure 
a compatible control command, requires at least three joints to occur and is 
related to a problem for higher level constraint formulations. To prevent kines- 
thetic instability, Lipkin and Duffy[66] proposed one formulation of kinestetic 
filtering which ensures that the decomposition of force and motion is invariant 
with respect to a change of origin, basis, or scale. 

2-3 Design aspects of teleoperator systems 

In order to realize the optimum operation of the teleoperator system, 
human dynamics, teleoperator system dynamics, the task environment and their 
interactions must be well understood and taken into account. In this section, 
the design aspects of tileoperator systems are considered. There are clearly 
many other design aspects of teleoperator systems to consider in addition to 
those listed in Table 2-1. More detailed descriptions on those design aspects 
can be found in [90]. 

The most important manual controller characteristics for the teleoper- 
ator system could be listed as follows: universal , bilateral or force-reflecting , 
magnitudes of maximum /minimum reflecting forces, dextrous working volume 
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Table 2-1 Desgin aspects of teleoperator system 


Geometric Aspects 

workspace shape/size and dexterity 

isometric/isotonic 

mobility (degrees of freedom) 

universal/non-universal 

geometrical simplicity 

serial /parallel/ hybrid structure 

modularity 

redundancy (in kinematics or actuators) 

Control Aspects 

digital/analog 

unilateral/bilateral/force- reflecting control 

direct joint /resolved position control 

position/rate control 

position/force/hybrid control (control variables) 

adaptive/non-adaptive control 

bilateral bandwidth and time delay 

compensation capability 

software backup functions (scaling, filtering, etc.) 

computational load 

task environments 

stability 

Component Aspects 

i 

sensors 

type of transmission/actuator 

backlash/ deadband 

friction/stiction 

durability /reliability of hardware 

hand grip/end-effector ( 

Dynamic Aspects 

end effector impedance 

effective inertia distribution(isotropic) 

gravity compensation 

compliance/rigidity 

Human Factors 

human operator dynamics 

resolution of position/reflecting force 

maximum/minimum reflecting force 

compactness/portability of manual controller 

operator fatigue/safety 

ease of operation/ training 

Others 

ease of maintenance 

economics 

L . _ 
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and position resolution, compact-size, light-weight, low friction and low effective 
inertia at hand grip, adjustable effective impedance at the hand, and optimal 
bilateral bandwidth of the system for time delay. For the sake of simplicity, only 
these aspects will be discussed briefly. 

Most bilateral teleoperator systems in use are designed to have a geo- 
metric similarity between the master and the slave system. The control effort 
for those systems could be simplified by direct joint-to-joint control between 
the master and the slave system. The drawbacks of this type of teleoperator 
system are the bulk of the master system, a fairly large working volume require- 
ment, its weight, and its difficulty in portability. They could actually limit or 
preclude the practical use of the system, such as in underwater submarine or 
space applications. For versatile applications of the master to various remote 
manipulators, it needs to be compact, light and portable while having a large 
dextrous workspace that does not interrupt the continuous motion of the human 
arm. 

Decoupled designs of the manual controller from the remote manipula- 
tor provide more flexiblity for the design of manual controllers to satisfy more of 
the design criteria mentioned above. It can be achieved at the expense of a lit- 
tle more sophisticated control effort (kinematical transformations are performed 
with respect to the universal end effector local frames for both the manual con- 
troller and the remote system). The detailed analysis on the kinematic mappings 
among various coordinate frames is provided in Appendix B. 

To provide task information to the human operator effectively (i.e., to 
increase the level of telepresence), bilateral control or force reflecting control are 
in common use. In bilateral control, reflecting force information is transferred 
in the form of the sum of the position and velocity errors between the man- 
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ual controller and the remote manipulator. In force-reflecting control, contact 
force experienced by the remote manipulator is directly reflected to the manual 
controller. 

The use of the force information in manipulator control has been shown 
to be very effective to improve the performance of the remote manipulator es- 
pecially when manipulator contact is involved with the environment. Studies of 
human performance in teleoperation with and without force information shows 
improvement of the task completion time by 40 to 50 percent when force infor- 
mation is used [38]. Noting that the human hand is able to sense forces from 
0.016 to 4.5 Ibf, the desired minimum/maximum reflecting forces of the manual 
controller need to be selected accordingly to fully utilize the human capabilities. 
However, it should be noted that the minimum/maximum reflecting-forces are 
also related to magnitudes of friction and actuator limitations (for the design of 
the universal force-reflecting spherical 3-dof manual controller, the continuous 
maximum reflecting-forces of 5 lb f and the peak reflecting-forces of 8 to 10 lb s 
at the handgrip are used as design goals). 

To reduce the confusion or distraction of the human operator, the mag- 
nitude of friction and any undesired dynamics of the manual controller should 
be minimized as much as possible and compensated if they are too large. 

Humans are known to have outstanding adaptability for various task 
environments. Humans operators can change arm impedance depending on the 
desired task characteristics. It should be noted, however, that as shown by 
Hogan experimentally in his recent research, the human arm impedance can not 
be adapted immediately for a changed task requirement, rather it takes 1.2 to 
1.5 sec to identify the task environment and to adjust his arm impedance[48]. 
For more enhanced teleoperator system operations or to handle more sophisti- 
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cated tasks effectively, the characteristics of the teleoperator system could be 
adjusted on-line as in bilateral-impedance control suggested by Hannaford[40] or 
off-line in advance[77] to augment the operator’s limited adaptation capability. 
These adjustable impedance variations of the manual controller and the remote 
manipulator could expand their current functional capabilities. 

Due to the instability arising from the time delay, the bilateral band- 
width of the system must be selected to optimize the system performance. A 
number of studies have been performed on manipulation with a user variable 
system time delay, where the time delay associated with the human is assumed 
negligible and not considered. According to their results, in order to achieve the 
stable response of the system and a favorable task completion time, time delays 
of less than 0.1 seconds should not be exceeded in the teleoperator system. In 
that case, the required bandwidth of the teleoperator system is found to be 
around 4.5 Hz\ 14]. The time delay problem is not a subject of this research. 
Additional detailed studies on time delay can be found in [6] [8] [27] [81]. 

Finally, the design and control characteristics of three different systems, 
the industrial robots, the remote system and the manual controller system, are 
compared in Table 2-2 to show their different functional/design perspectives. 
It should be transparent from the table that the design and control of manual 
controllers, industrial robots, and teleoperator systems require the knowledge 
on their individual task requirements and specifications to optimize their func- 
tions. A properly balanced design of a teleoperator system, along with advanced 
computer/actuator technology and control strategies, will provide a promising 
future for a teleoperation technology. 
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Table 2-2 Functional CHARACTERISTICS of typical industrial manipulators, uni- 
versal BILATERAL MANUAL CONTROLLERS AND REMOTE MANIPULATORS. 


Characteristic 

Industrial 

Manipulator 

Universal 

Manual 

Controller 

Remote 

Manipulator 

Functional 

Nature 

Autonomous 

Repetitive 

Manual 

Teleoperation 

Manual 

Teleoperation 

Environment 

Simple 

Structured 

Human operator 
Interface 

Complex 

Uncertain 

Size 

Large 

Compact 

Small/ Large 

Weight 

Heavy 

Light 

Light/ Heavy 

Actuator 

Location 

Distributed 

Centralized 
Base Mounted 

Distributed 

Compliance 
in Drive 
Transmission 

Stiff 

Rigid 

Non-Backdrivable 

Flexible 

Backdrivable 

Flexible 

Backdrivable 

Friction 

Large 

Small 

Small/ Large 

Inertia 

Large 

Small 

Small/ Large 

Load 

capacity(/6y) 

25-200 

2-20 

5-200 

End-Effector 

Specialized 

Joy-Stick 

Inter- 

changeable 

Control 

Variables 

Joint Actuator 
Position 

End-Effector 

Position/Force 

End- Effector 
Position/Force 

Application 

Structured 

Task 

Light Duty 

Unstructured 

Task 
































CHAPTER 3 


General Background on Teleoperator Systems 


In this chapter, the general background on the teleoperator system is 
described. Previous design efforts, currently available control strategies and 
computer support functions are presented. Also manual controller classifica- 
tions, their comparison based on performance and properties, and performance 
evaluation methods are briefly presented. 

3—1 Previous work on teleoperator system design 

In this section, the typical design efforts for teleoperator systems are 
briefly reviewed in various application areas. 

In the late 1940’s, Ray Goertz and his group at the Argonne National 
Laboratory developed the first mechanical bilateral master-slave system. The 
master-slave system was developed for the remote manipulation of objects in 
a highly radioactive environment (a “hot cell” )[36]. However, this mechanical 
master-slave could not be controlled when the two manipulators were more than 
a few feet apart, because they were physically linked. In 1954, Goertz built the 
first bilateral force- reflecting servo-manipulator. This manipulator used bilateral 
servo loops with low friction, high efficiency torque transmission. By 1965, 
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Argonne National Laboratory had introduced the control concept in which the 
operator used head-activated controls to move remote site TV cameras. 

In 1948, General Mills introduced a simple on/off switch box controller, 
which used electric motors to control the manipulator in an unilateral sense. In 
1958, General Electric began developing the Handyman electrohydraulic ma- 
nipulator, which included force-reflection, articulated fingers, and an exoskele- 
tal master controller. However, their bulky dimensions made the Handyman 
impractical[72]. 

The hazardous environments encountered in space exploration forced 
NASA to develop advanced teleoperator systems. During the 1970’s NASA 
used such systems to control the soil samplers sent to the Moon and Mars, and 
began developing the Remote Manipulator System (RMS) for the space shuttle. 
The RMS teleoperator system used two 3-dof hand controllers, the left hand 
controller for controlling translational motion of the end effector of the RMS 
and the right hand for controlling rotational motion[78]. The system primarily 
uses resolved unilateral rate control, but an emergency backup mode is included 
to allow for direct manual control of the individual joints. In the future, NASA 
plans to use teleoperator systems in the assembly and routine maintenance of 
the space station[2). 

Also during the 1970’s, the nuclear community began serious efforts 
to develop teleoperator systems for use in the maintenance of nuclear power 
plants. In 1977, Teleoperator System Corporation produced the SM-229, a 
bilateral force- reflecting master/slave manipulator designed for use in nuclear 
plants [29]. 

Draper Laboratory at MIT has developed an isometric hand controller 
which implements resolved motion rate control (introduced by Whitney at MIT) 
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[98]. While this controller exhibits a very compact design, its limited motion 
range makes force- reflection and kinesthetic feedback very difficult. In 1985, 
Landsberger and Sheridan developed a parallel-link arm using cables in tension 
and a single passive compressive spine. The system can use both resolved motion 
control and rate control[60]. 

Artificial Intelligence (AI) concepts were introduced with the develop- 
ment of microcomputer technology. As a result, “supervisory” and “universal” 
control concepts have been introduced to teleoperator systems. In 1980, Brooks 
at MIT first demonstrated supervisory control concepts in hardware[ll]. Su- 
pervisory control can be seen in modern aircraft, chemical plants, steel mills, 
discrete part manufacturing, and many other applications. 

In the early 1980’s, Oak Ridge National Laboratory (ORNL) began 
developing a series of master-slave teleoperator systems for nuclear plant main- 
tenance operations; the Model M-2 Maintenance System and the Advanced Ser- 
vomanipulator (ASM) system[42] [59] [69] . The Model M-2 Maintenance System 
uses two force-reflecting master controllers for two servomanipulator arms, tele- 
vision viewing, lighting, etc. The ASM uses a pair of modular-based bilateral 
force-reflecting master-slave controllers to increase the reliability of the system. 
However, the large size and anthropomorphic (elbow-down) geometry of the 
system restricts its applications. 

Since the late 1970’s and early 1980’s, universal concepts for tele- 
operator systems have been developed and refined mainly by Hill and Salis- 
bury at Stanford Research Institute (SRI), Bejczy at Jet Propulsion Labora- 
tory (JPL)[43], and Tesar at the Center for Intelligent Machines and Robotics 
(CIMAR) at the University of Florida and after 1985, at the University of Texas 


at Austin. 
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In 1980, JPL and SRI developed a universal, bilateral force- reflecting 
6-dof manual controller [10]. The geometry of the controller was chosen to sim- 
plify the computational burden. A counter-balancing mechanism was included 
to minimize gravitational effects. The design effort was directed towards reduc- 
ing friction, backlash and effective inertia at the handgrip. It is designed to 
generate 35 oz of force and 70 oz-in of torque at the handgrip with a 12 inch 
cube workspace. It used the cable/pulley-based counter-balancing and power 
transmitting mechanism. 

In the late 1970’s, Tesar at CIMAR developed a unilateral/universal 
6-dof nine-string manual controller [64] and a bilateral force-reflecting 4-dof pla- 
nar controller^ 3] [95]. The nine-string controller has almost negligible effective 
inertia, while maintaining a reasonable workspace size. It was also an attempt to 
apply parallel geometry on a manual controller design. The 4-dof controller was 
developed to evaluate the applicability of both force reflection and redundancy 
to the manual controller design. 

Since 1985, Tesar at the University of Texas developed two force- 
reflecting manual controllers; a 3-dof 3-string manual controller and a 6-dof 
9-string manual controller[3][63][90]. Both manual controllers utilize parallel ge- 
ometry and showed negligible effective inertia due to its actuator locations on 
the fixed base. Both controllers were interfaced with the Cincinnati Milacron 
T 3 — 726 Industrial Robot and showed successful performance. 

Currently, teleoperator systems are in use in several areas (nuclear, 
space, military, mining, etc.). In the nuclear industry, teleoperators are used 
in equipment maintenance and material handling operations in radioactive en- 
vironments. Various branches of the U.S military are involved in teleoperator 
system design. The Navy has developed and applied Remotely Operated Vehi- 
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cles (ROV) for underwater operations. The Army is developing a teleoperator 
system for material handling applications. And for decades, the Air Force has 
been applying manual controller (joystick) concepts for aircraft control. 

A handful of industrial companies (Kraft Telerobotics Inc., etc.) are 
marketing complete force-reflecting systems, which are used in hazardous en- 
vironments (i.e., under-sea opeations). In 1983, Odetics developed a tetherless 
electromechanical walking machine with a lift-to-weight ratio greater than one 
[91]. Several foreign countries have also been developing teleoperator systems 
(the MF3 manipulator vechicle in West Germany, the ME-23 servomanipula- 
tor in France, MASCOT in Italy, BILARM-83A in Japan, the RMS arm in 
Canada, etc.) [15] [59]. The success of these operations ensures the continued 
development and application of industrial teleoperator systems. 

3-2 Classification of previous control strategies for teleoperator sys- 
tems 

In this section, the various classical control strategies for teleoperator 
systems are briefly explained. The fundamental control strategies for teleoper- 
ator systems may be divided into three categories: 

• The controlled parameters of the manipulator (position, rate, force). 

• Type of output space of the manipulator: direct (control of joint angles) 
or resolved (control in operational space). 

• The direction of information flow (unilateral or bilateral) 1 

bilateral controllers both provide output and receive feedback(position or velocity) from 
the manipulator; unilateral controllers only provide output to the manipulator. 
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The typical control strategies which were in popular use are briefly described in 
the following[12]. 

Direct Rate Control (DRC): The velocity of each manipulator joint is directly 
controlled by an individual manual controller output. The operator can adjust 
the proportional gains or the manipulator-joint- velocity/controller-output ratio. 
The simple button box controller uses this control mode. 

Resolved Rate Control (RRC): The velocity of each degree of freedom in task 
coordinates 2 is controlled by an individual manual controller output. 

Direct Unilateral Position Control (DUPC)\ The position of each manipulator 
joint is directly controlled by an individual manual controller output. There 
is no manipulator information feedback (joint position, velocity) to the manual 
controller (human operator). It is implicitly assumed that the manipulator dy- 
namics are fast enough to follow the controller input; otherwise, the performance 
of the system may be deteriorated. 

Resolved Unilateral Position Control ( RUPC The position of each manipula- 
tor degree of freedom in task coordinates is controlled by an individual manual 
controller output. 

Direct Bilateral Position Control ( DBPC '): Same as DUPC above, except that 

position feedback from the manipulator joints can be used to synchronize the 

motion of the manipulator and the manual controller. This position feedback 

from the manipulator joints indirectly transfer the contact force information to 

the manual controller. To improve synchronization, the manual controller joint 

velocities can be fed forward to the manipulator joint servos, while the manip- 

2 Task coordinates(or wo.ld coordinates) are attached to the control point of the manipu- 
lator (usually the tool point or the center of the end effector) and/or the manual controller 
(usually the center of the hand grip). Task coordinates usually coincide with Cartesian coor- 
dinates, which feels natural to human operators. 
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Manual controller 


Remote manipulator 



Figure 3-1 Direct bilateral position control 
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ulator joint velocities are fed forward to the manual controller servos as shown 
in Figure 3-1. This bi-directional error signal results in force- reflection to the 
manual controller and the manipulator. The DBPC control mode is most com- 
monly used in master-slave teleoperator systems. 

Resolved Bilateral Position Control (RBPC): The same as RUPC above, except 
that position feedback from the manipulator joints can be used to synchronize 
the motion of the manipulator and the manual controller. This position feedback 
from the manipulator joints indirectly transfer the contact force information to 
the manual controller. When a universal manual controller is used in this control 
mode, the joint displacements and velocities of the controller are combined and 
resolved to create task coordinate displacements and velocities. The controller 
coordinates and variables (position and velocity) are thus resolved into manip- 
ulator task coordinates and variables. As in DBPC, the manual controller and 
manipulator joint velocities can be fedforward to each other to initiate force re- 
flection. This type of control comes at a cost, due to the computational burden 
of converting between coordinate systems. However, most additional control 
functions (direct scaling of position, velocity, and force in task coordinates, re- 
referencing, etc.) are available in this mode. 

Direct Force- Reflecting Control(DFRC): This control can be applied to only 
the master-slave teleoperator system. As shown in Figure 3-2, the position of 
the manipulator is controlled by the output position of the manual controller. 
Any external forces felt on the manipulator will be reflected on the manual con- 
troller. This control can transfer the most sensitive environmental information 
to the manual controller and has been shown to be very effective in teleoperation 
involving contacts with an unstructured environment. The main difference of 
this control from the DBPC is how to transmit the environmental information 
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to the manual controller, that is, the DFRC uses direct force feedback and the 
DBPC uses indirect position/velocity feedback. 

Resolved Force- Reflecting Control(RFRC): The same as the above DFRC ex- 
cept that both the manual controller and the remote manipulator are controlled 
in task coordinates. It allows the independent design of the manual controller 
from the remote manipulator. Also as in RBPC, most available computer aug- 
menting control functions can be applied in this mode. 

Besides the above control strategies, there are other control functions 
aided by the control software[88]. 

Motion Filtering-. “A process in which extraneous motion that is superim- 
posed upon the control signal by the operator is detected and subsequently 
deleted.” [88] For example, in a miniature replica master-slave system, small 
command signals from the miniature replica controller are amplified. Filtering 
smooths out the undesired jitters produced by the human operator (due to fa- 
tigue, etc.). 

Scaling: The ability to dynamically vary the geometric gain between the man- 
ual controller and the manipulator. Scaling allows a single controller to be used 
for both gross and fine motions (for precision operations) by varying the corre- 
sponding gains. Scaling can also be used to create motion constraints on the 
manual controller to help/guide the operator (motion projection, where zero 
gain represents zero motion along the corresponding direction). Scaling is only 
effective when the geometries of the manual controller and the manipulator are 
decoupled (the universal controller concept). 

Re-referencing: Allows the operator to reposition the manual controller to a 
more comfortable or desirable position, without moving the manipulator. This 
control function is useful when the motion range of the manipulator is limited 
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by the workspace of the manual controller, or when the manual controller is in 
an uncomfortable or undesirable position. Re-referencing allows the operator to 
increase both the dexterity and the virtual operating range of the controller. As 
with scaling, re-referencing is effective only when used with universal controllers. 
Re- orientation: Allows the operator to compensate for an altered perspective 
between the manual controller and the manipulator. When the manipulator task 
coordinates or the visual perspective of a scene are altered, the operator can re- 
store the desired controller/manipulator spatial relationship by transforming the 
controller output to match the altered perspective. Re-orientation is effective 
only when used with universal controllers. 

Force Reflection: Forces and torques perceived at the end-effector are repro- 
duced at the hand grip of the manual controller, allowing the operator to feel any 
external forces/torques as if he/she were moving the end-effector itself. Force 
reflection is extremely helpful during operations in uncertain environments. 
Force Indexing: Allows constant manipulator loads (external loads, manipulator 
wrist weight, etc.) to be subtracted from the forces reflected back to the hand 
grip of a manual controller, thus reducing undesirable effects (such as operator 
fatigue). Obviously, force indexing can only be used when force reflection is 
available (bilateral systems). 

Compensation: Reduces or eliminates undesirable dynamic effects, friction, 
gravitational effects, nonlinear effects, etc. from a teleoperator system. Com- 
pensation reduces operator fatigue and improves control, but the software often 
requires a large amount of high level computation. Compensation techniques 
should be balanced to enhance individual tasks or teleoperator systems. 

Motion Constraints: Artificial constraints are placed on the manipulator to ei- 
ther improve control or protect the system. Motion constraints can be based 
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on the task environment model, sensory data, etc. Examples include potential 
force fields (used for trajectory guidance, obstacle avoidance, etc.) and force 
accommodation (adaptive compensation of unexpected forces /torques applied 
to the end-effector, useful in insertion tasks, etc.). 

Variable Control Point : Allows the operator to simplify the task by electron- 
ically selecting the most desirable manipulator control point (tool, wrist, end 
effector, etc.). Variable control points can only be achieved on decoupled sys- 
tems (universal controller concept). 

Teach and Repeat: Allows the operator to “teach” the manipulator a movement 
or activity which can be autonomously repeated at a later time. This function 
is useful for repetitive tasks requiring no human supervision. 

3-3 Manual controller classification 

Manual controllers may be classified by various aspects: 

• Geometry (joystick, replica, master-slave, anthropomorphic, universal, etc.) 

• Working volume (button box, joystick, manual controller, etc.) 

• Number of degrees of freedom (non-redundant, redundant, etc.) 

• Control variables (position isotonic or rate; force isometric, force-induced 
displacement, hybrid, etc.) 

• The direction of information flow (unilateral or bilateral) 

Some typical manual controllers are described [12] [88]: 

Button Box Rate Controller: The simplest type of manual controller is the 
switch or button box controller. These controllers have individual buttons, 
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switches and/or knobs to control the velocity of each manipulator joint either 
directly or in task coordinates. The simplicity of the button box accounts for its 
widespread use with industrial manipulators; however, button boxes represent 
the slowest teleoperator control available, with typical performance times 20 to 
100 times slower than master-slave controllers. 

Small Motion Joystick Controller. This is the classical “joystick”, where the 
motion range is only a few inches at most. The biggest advantage of the joystick 
is that it has a very small working volume; the biggest disadvantage is that the 
operator error is amplified along with the control signal. The small motion joy- 
stick is usually used as a proportional rate controller , but it can also be used 
as a position controller. Two 3-DOF joysticks of this type are used to control 
NASA’s RMS Arm. 

Isometric Joystick Controller : The isometric (immovable) proportional rate 
controller exhibits a very compact design, requiring a minimum of working vol- 
ume. Transducers (strain gauges) within the manual controller measure the 
forces applied by the operator, which are used to control the manipulator ve- 
locity either directly or in task coordinates. Due to its small motion range, 
the isometric manual controller is not capable of reflecting forces applied to the 
manipulator. 

Isotonic Manual Controller: An isotonic (constant force) manual controller uses 
resolved position control for two or more degrees of freedom in limited work vol- 
umes. A “trackball” is an example of this type of controller. Isotonic controllers 
axe not suitable for force reflection. 

Hybrid Manual Controller . The hybrid controller combines aspects of the iso- 
tonic and isometric controllers, but they are mutually exclusive for a given degree 
of freedom. There are two basic implementation philosophies: concurrent and 
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sequential. In a concurrent controller, each degree of freedom is separately con- 
trolled by an input force, position, or displacement. In a sequential controller, 
each degree of freedom can be controlled by a combination of input force, posi- 
tion, or displacement by alternating between isotonic and isometric modes. 
Replica Manual Controller : The replica controller is a scaled-down duplicate of 
the manipulator, which allows the operator to control huge, high payload ma- 
nipulators. Due to geometric scaling, all operator input is amplified, including 
undesirable jitters and any nonlinear properties of the controller (backlash, etc.); 
this makes the performance of high-precision tasks difficult. In addition, most 
control function software (for re- referencing, scaling, etc.) cannot be adapted 
to the replica master controller, because of the geometric coupling between the 
manipulator and the controller. 

Master-Slave Teleoperator System: Two geometrically similar manipulators are 
interfaced such that the operator controls one manipulator (the master) while 
the other (the slave) duplicates the motion of the master. Control of the master- 
slave teleoperator system is quite simple, as long as the master and slave ma- 
nipulators remain close geometrical replicas (maintaining their geometric and 
dynamic similarities). However, as in the case of the replica manual controller, 
the geometric similarity (direct joint-to-joint coupling) between master and slave 
prevents the use of control function software for performance enhancement. 
Anthropomorphic Manual Controller: Anthropomorphic controllers are used to 
maximize the human operator’s own control capability by using the human arm 
as the geometrical base. The manipulator is usually geometrically similar to the 
anthropomorphic controller. These controllers show good performance within 
humans’ dexterous range, but are restricted in certain tasks (i.e., operations re- 
quiring high precision, complex geometries, etc.) which may be more effectively 
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accomplished with a non-anthropomorphic geometry. 

Universal Manual Controller. As a result of rapid advancements in computer 
technology, it is now possible (with proper transformation software) to interface 
a manipulator with a geometrically dissimilar manual controller, called a “uni- 
versal controller”. The ability to adapt to manipulators with different geome- 
tries provides the universal controller with many promising advantages. With 
the universal controller, the position and velocity of both the manipulator and 
the manual controller can be controlled in task coordinates, which feels more 
natural to the operator. 

While all of the manual controllers have their own particular merits 
and demerits, the master-slave, anthropomorphic, and universal manual con- 
trollers appear to have clear advantages over the others. The ability to apply 
a variety of interface and control functions (“natural” control with force and 
proprioceptive feedback, reduced operator workload, reduced training time and 
expense, reduced probability of errors, etc.) enhances the performance of these 
controllers. 

A comparison of the master-slave, anthropomorphic, and universal con- 
trollers clarifies the differences between them. Master-slave controllers have 
direct configuration feedback (due to the duplicate geometry of the controller 
and manipulator), but they may lack in anthropomorphism and compactness. 
Anthropomorphic controllers often lack compactness and versatility, and their 
functional capabilities may be limited by the human operator. Universal con- 
trollers are versatile and compact, but they lack direct anthropomorphism and 
configuration feedback. 

It should be noted that the main difference between a master-slave 
controller and a universal controller lies in the geometrical coupling/decoupling 
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to the manipulator. Due to its geometrical dependence on a particular slave 
manipulator, the performance of a master-slave teleoperator system would be 
dramatically reduced if used as a universal controller (e.g., if it was linked to a 
slave of different geometry), because the controller design may not be compact 
or ergonomic. While a universal controller cannot be made to mimic the master- 
slave’s direct configuration feedback, its versatility and ergonomic design make 
it the most promising controller, because the controller and the manipulator 
can be specially designed for their particular requirements. Tables 3-1 (adapted 
from [88]) and 3-2, and Figure 3-3 (adapted from [88]) compare the functional 
properties and performance of various manual controllers. 

4 Performance evaluation of teleoperator systems 

While many evaluation techniques have been proposed for quantifying 
the performance of teleoperator systems and their various control modes, there 
is no industry standard. Performance is usually evaluated either by measuring 
the mean task-completion time or by counting the number of errors occurring 
during a specified task. While the time ratio performance measurement tech- 
niques are currently the most popular, the error/success ratio techniques are 
also important in teleoperator system evaluation. It should be noted that time 
ratio measurements are valid only when comparing tasks of the same complexity 
(same degree of constraint) [28] [56] [67] [88] [96]. 

• Information- Based Performance (Fitt’s Law): Base the teleoperator sys- 
tem performance upon an index of difficulty: 


h = log 2 (^) 


(3-4.1) 



42 

where 

Id = index of difficulty (Fitt’s index). 

A — distance between targets in a repetitive motion. 

B = the width of the target (tolerance). 

Fitt’s Law is defined as: 

T = aid + b (3-4.2) 

where 

T = task completion time. 
a and b are determined experimentally. 

• Unit-Task Completion Time - Measurement of the completion time for a 
specified unit task, such as “insert”, “grasp”, etc. 

• Task/Time Ratio : Comparison of task completion time between the tele- 
operator system and a human operator. 

• Error/Task Success Ratio : Compares the number of errors expected using 
various teleoperator systems during a specified task. 

Bilateral master-slave systems have demonstrated the best performance 
of all teleoperator systems (based on time ratio evaluation techniques), yet they 
are still 2 to 15 times slower than a human. All other systems are currently 
3 to 10 times slower than the bilateral system, which suggests that increasing 
the level of telepresence improves performance. However, other control modes 
should not be completely overlooked, as they often perform better than bilateral 
master-slave systems in certain applications. 
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Coupled Decoupled 

Geometry^ Geometry 


Figure 3-3 Ranking of various man-machine technologies by level of perfor- 
mance (Adapted from [88]). 














Table 3-1 FUNCTIONAL PROPERTIES OF MANUAL CONTROLLERS (ADAPTED FROM [88]). 


Functional 

Property 

rate 

button 

box 

isometric 

rate 

control 

master 

slave 

anthropo- 

morphic 

universal 

bilateral 

redundant 

universal 

bilateral 

motion 

filtering 


• 

• 

• 

• 

• 

motion 

constraints 



• 

• 

• 

• 

resolved 

motion 

control 



• 

• 

• 

• 

compensation 



• 

• 

• 

• 

force 

reflection 



• 

• 

• 

• 

variable 

control 

point 


1 



• 

• 

scaling 


- 1 

i 




• 

re- 

referencing 





• 

• 

re- 

orientation 





• 

• 

intelligence 






• 
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Table 3-2 Performance characteristics of manual controllers (adapted from 
[ 88 ]). 


Evaluation 

Criteria 

rate 

button 

box 

isometric 

rate 

control 

master/ 

slave 

- 

anthropo- 

morphic 

universal 

bilateral 

redundant 

universal 

bilateral 

task 

performance 

time 

poor 

fair 

best 

good 

good 

good 

decoupled 

interface 

yes 

yes 

no 

no 

yes 

yes 

natural 

motion 

poor 

fair 

very 

good 

excellent 

very 

good 

very 

good 

control 

device 

implemen- 

tation 

simple 

simple 

direct 

direct 

difficult 

difficult 

attainable 

accuracy 

poorest 

i 

fair 

good 

good 

good 

good 

cost 

\ lowest 

low 

moderate 

high 

moderate 

highest 

reliability 

I very 
good 

good 

good 

poor 

good 

fair 

control 

mode 

applicability 

poorest 

poor 

fair 

fair 

very 

good 

excellent 

computa- 

tational 

burden 

lowest 

moderate 

low 

iow 

high 

very 

high 

compactness 
& size 

best 

excellent 

good 

poor 

poor 

very 

good 

good 

dexterity 

worst 

fair 

good 

good 

very 

good 

excellent 



CHAPTER 4 


Kinematic Analysis of the Parallel Spherical 3-dof System 


The kinematic design of the robotic manipulator requires various con- 
siderations to accomplish the desired system performance. Due to its kinematic 
and dynamic simplicity and its dextrous large working volume, most current 
robotic systems in use are primarily based on a serial structure. However, its 
low structural stiffness and low load capacity represent disadvantageous charac- 
teristics for its versatile applications. 

The parallel structure could, in general, have larger load capacity and 
higher structural stiffness than the serial structure. Heavy actuators could be 
located toward and/ or on the base and parallelism increases the structural rigid- 
ity. However, as the number of degrees of freedom of parallel systems increases, 
both the complexity of the kinematic/ dynamic analysis and the computational 
burden increase. Only a restricted design of the parallel system could be useful. 

Most of available bilateral or force-reflecting manual controllers use 
elementary architectures (serial structure). However, as discussed, the parallel 
structure represents promising aspects for bilateral or force-reflecting manual 
controller applications such as locations of actuators on the grounded base, 
structural stiffness, etc. 
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A 3-dof parallel spherical shoulder system has been studied for its pos- 
sible applications to robotic systems by several researchers [18] [20] [68]. In this 
chapter, the kinematic and dynamic analysis for the parallel 3-DOF spherical 
shoulder system are reviewed, and the forward position analysis is presented for 
a universal manual controller application. 

4-1 Mobility analysis 

The degrees of freedom of the spherical shoulder could be confirmed by 
the general mobility criterion, called Grubler’s or Kutzback’s criterion[50], 

M = m(n - 1) - ]T(u.) (4-1.1) 

»=i 

where M: mobility 

m: the dimension of maximum output space of n bodies 
n: the number of completely unconstrained bodies 
g: the number of joints 
Ui : the number of constraints on joint i. 

In this formula, the dimension of the maximum output space of n bodies, m, 
requires more considerations. In general, spatial motion represents 6 dimensional 
space motion. However, due to the lack of geometrical generality in certain 
situations, the full 6 dimensional motion space could not be covered by the 
mechanism; because of singularity points, the motion space of a mechanism 
could be reduced by more than one-dof. 

As in the planar motion mechanism, the spherical shoulder has its nine 
joint axes co-intersecting at a common point, thus constraining the motion to 
be purely spherical. For convenience, the simplified schematic of the shoulder 
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is given in Figure 4-1. In actuality, the number of degrees of freedom of the 
mechanism is restricted to three dimensional spherical space; the motion path 
of any point on the link is restricted to the surface of the sphere which has an 
origin at the common intersecting point. 

With the substitution of m = 3 into the above mobility criterian (as- 
suming spherical motion of the mechanism), the mobility, M, would be obtained 
as below; 

M = 3(8 - 1) - 2 x 9 = 3. 

However, when we insert d = 6 into the criterion without the above consideration 
(assuming general spatial motion of the mechanim), the mobility, M, could 
result in; 

M = 6(8 -1) — 5x9 = —3. 

By examining the mobility results from these two cases, it can be seen that the 

top plate 



Figure 4-1 Simplified schematics of the shoulder 
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number of overconstraints imposed on the system are six (they are different by 
six). When some of these six overconstraints are removed, the shoulder would 
not increase its mobility (3-dof) at all, but it could decrease the structual rigidity 
of the mechanism. Note also that due to its overconstraints, the shoulder system 
becomes structurally indeterminate and requires compatibility conditions for its 
force and torque analysis[20]. 

4-2 Kinematic description 

The shoulder system, shown in Figure 4-2, is a multi-loop, spherical 
mechanism. It consists of a lower (or base) ternary, three serial subchains, and 
a upper (or top) ternary. Each serial subchain consists of three revolute joints 
(since they are serially connected, it can be represented as a RRR dyad). To 
satisfy the geometric constraints for a parallel spherical 3-dof motion, nine joint 
axes intersect at a common point. In this section, kinematic parameters of the 
shoulder are briefly described or reviewed. Note, however, that to directly be 
applicable as a modular component in a multi-dof manipulator, the local frames 
for the mechanism will be defined slighly differently from the previous works[18]. 

The rotation axis direction for each revolute joint is denoted as a unit 
vector, s™, as shown in Figure 4-3. The superscript, m, shall denote the sub- 
chain and the subscript, n, shall denote the joint. The two reference unit vectors 
perpendicular to the lower ternary plate and to the upper ternary plate are de- 
noted as s b and s ( , respectively. The base frame fixed on the lower ternary 
(*6 y b z b ) and the top frame fixed on the upper ternary (x t y t z t ), are defined. 
Three serial subchains are defined as open linkages connecting those two bases 
and top frames. The orientation of any link in a serial subchain, m, can be 
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described by a minimum of two vectors attached to the link, namely, s™ and 
a™. The unit vector, a?-, is defined by 

a" = s? x sf. (4-2.2) 

The transformation matrix, representing the jth local frame direction 

cosine with respect to the reference frame r, can be expressed as shown below, 

rm] = k 8 t x »n. (4-2.3) 

The twist angles, which are defined as rotation angles about the axis, a™, 
between two subsequent revolute axes, a”* and s™, are fixed geometric properties 
of each binary link and denoted by a™. Mathmatically it can be represented by 

cos a™ = 8™ -8™. (4-2.4) 

To describe the offset angles between the subchain frames and refer- 
ence frames (base and top frames), apex angles and edge displacement angles 
are defined. Apex angles, representing twist angles between the lower ternary 
reference unit vector, «<,, and the lower joint axis, and the upper joint axis, 
s™, and the upper ternary reference unit vector, are denoted as (or a£J) 
and a™ 4 (or a™ t ), respectively as shown in Figure 4-3. In mathmatical form, 
apex angles can be written as follows; 

cos • 8™, where m = 1,2,3, for lower ternary , (4-2.5) 

cos ol™ 4 = s™ ■ 8 t , where m = 1,2,3, for upper ternary. (4-2.6) 

Edge displacement angles which represent offset rotation angles about lower 
(upper) ternary reference unit vectors, s&(st), between the lower (upper) ternary 
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Figure 4-3 Kinematic representation of the shoulder 
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reference frame and the local frames, are denoted as 7 ol( 7 ^)- The unit vector 
describing the orientation of the ternary links are defined as 

a oi = 8b x s™, where m = 1,2.3. for lower ternary , (4-2.7) 

a 34 = S 3 1 X s t , where m = 1,2,3. for upper ternary. (4-2.8) 

Based upon the above parameter notations, the complete kinematic 
description of each serial subchain can be represented as in Table 4-1. In the 
table, 5,7 represents the offset distance along the local rotational joint axis, s’", 
and 4>™ represents the active joint angular displacement about the local rota- 
tional joint axis, s™. In Figure 4-3, the schematic representation for kinematic 
parameters for a serial subchain of the shoulder system is shown. 

4—3 Coordinate system and transformation 

To represent the relative input and output position and orientation of 
the shoulder, two reference coordinate systems are required. Since the geometry 
of the shoulder allows only the rotational motion about the common intersection 
point, the origins of all local coordinates are located at that point. One body 
fixed coordinate system, fixed to the lower ternary, provides the references for 
input positions and is denoted as a base frame (»(,, y b , z b ). The other body 
fixed coordinate system, fixed to the upper ternary, provides the references for 
output positions and is denoted as a top frame ( x t , y t , z t ). For convenience, 
these two coordinate systems are defined so that they coincide at the reference 
position. 

The output position of the shoulder system is represented by Euler 
angles denoted by p,\, /i 2 , and These Euler angles can be represented by the 



4-4 Edge di 




Table 4-1 kinematic parameters of the shoulder 


Serial sub chain # 1 

subchain 

joint 

Cm 

4>i 

a i*+l 

sy 771 

a u+l 

base ternary 

0(b) 

0 

7oi 

0 

a mKi) 

i 1 

1 

0 

<t>\ 

0 

°12 

1 

2 

0 


0 

a 23 

1 

3 

0 

$3 

0 

a 34( a 3«) 

top ternary 

4(t) 

0 

7.34 

0 

o ; 

Serial subchain # 2 

subchain 

joint 

Cm 

°u 

4>i 

a u+l 

a I?+ 1 

base ternary 

0(b) 

0 

7oi 

0 

<(<) 

2 

1 

0 

4>\ 

0 


2 

2 

0 

4> 2 

0 

<*23 

2 

3 

0 

4> 3 

0 

a 34( a 3t) 

top ternary 

4(t) 

0 

734 

0 

0 

Serial subchain # 3 

subchain 

joint 

Cjrrx 
*'■' ti 

<k 

a «+l 

°«+l 

base ternary 

0(b) 

0 

7oi 

0 

«0l(«6l) 

3 

1 

0 

4i 

0 


3 

2 

0 


0 

a 23 

3 

3 

0 

<t>\ 

0 

<4l(<4) 

top ternary 

4(t) 

0 

7.34 

0 

0 
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equivalent transformation matrix, or direction cosines of the top ternary body 
fixed coordinate frame with respect to the base ternary body fixed coordinate 
frame. That is, 

[/?£] = Rot(x, ni)Rot(y, n?)Rot(z,fi 3 ) 

10 0 cfi 2 0 Sfi2 cfi 3 —sfi 3 0 " 

0 cfii 0 10 sfi 3 c[i 3 0 

0 Sfi i c\i x j [ -sfi 2 0 -c/x 2 J [ 0 1 

^2^3 ~Sfi 2 Sfl 3 Sfi 2 

•S^i sfi 2 Cfi 3 + cniS(i 3 -suxSfcSfo + cfi\Cfi 3 -Sfixcn 2 (4-3.9) 

— Cfl\Sfi 2 SfJ, 3 + SfliCfi 3 Cfi\Sfl 2 Sfi 3 -J- Sfl\Cfl 3 CHiCfl 2 

or 

[#fc] = [a t s t x a t s t ] (4-3.10) 

where the superscript, f, and the subscript, b, denote the top ternary body fixed 
reference coordinate frame and the base ternary body fixed reference coordinate 
frame, respectively. 

Now, for the serial subchain of the shoulder, any intermediate local 
coordinate systems may be defined and their direction cosines be provided for 


future references. 

[#r] = K *6 x a b s b ] (4-3.11) 

(*, 7 £I)] = [a 0 i s b x a 0 i **] (4-3.12) 

[•^r] [Rot^Zj 7oi <*oi )] = [<*oi ®i x <ioi ®i] (4—3.13) 

[R b r \[Rot{z, 7^)][i2of(x, a^)][i2o<(2, <^)] = [a 12 *i x a 0 i «i] (4-3.14) 

= (<*12 *2 X o 12 s 2 ] (4-3.15) 

[i2 r ][/?f,][f?ot(x, a^)][/?ot( 2 , ^)] = [a 2 3 s 2 x s 2 ] (4-3.16) 
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[Rj][Rj][fti][/2ot(a;,Q^)] = [a 23 s 3 x a 23 * 3 ] 

(4-3.17) 

a%)][Rot(z, ^)] = [ a34 s 3 x a34 s 3 ] 

(4-3.18) 

[i?T-][-^6][-Ri]f^? 2 ][^' 0 ^( ;J:: » = [ a 34 s t x a 34 *t] 

(4-3.19) 

[^r][-Ri][-Ri][^ 2 ][^°^( ;r ? » 3 4 )][^c>f( 2 , 7 ^ 1 )] = [a t St x a t s<] 

(4-3.20) 

where 


[Rl] = [Rot{z^ x )][Rot{x,aZ)][Rot{z,^)} 

(4-3.21) 

{R\] = [Rot(x,a™)]{Rot{z,<!%)) 

(4-3.22) 

] = [Rot(x,aZ))[Rot(z,<%)} 

(4-3.23) 

1*3] = [Rot(x,a™))[Rot(z, 7 -)]. 

(4-3.24) 


Note that [i?*] — (/?;■] [/?*■], represents the direction cosines of the ifcth 
local frame with respect to the zth local frame, and that any local vector, 
in &th local coordinate frame can be expressed in zth coordinate frame by 


r {i) = [R*]r (fc) . (4-3.25) 

4—4 Reverse position analysis 

Finding the angular displacements of the dyad joints when the out- 
put position of the system (upper ternary link) is specified, is referred to as 
the reverse position analysis. In the shoulder system, three base joints from 
each serial subchain are actuated. To locate the shoulder system at a speci- 
fied position/orientation, these three actuated joint angular positions need to 
be determined. In this section, the reverse position analysis for the shoulder is 
presented. 
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Given an output position or orientation of the system in terms of Eu- 
ler angles, three independent sets of equations can be written for each serial 
subchain. 

[Rl} = [ m Reform = 1,2,3, (4-4.26) 

where m denotes the serial subchain. The left hand side is a desired output 
transformation matrix of the system given in equation (4-3.9) and the right 
hand side is written in terms of the serial subchain variables as below, 


FRl) = rRirRlTRlTRl) for m = 1,2,3 (4-4.27) 

where 

[ m Rl] = [ Rot{z,7™)][Rot(x,a™))[Rot{z,<t> 7*)] (4-4.28) 

l m R\) = [Rot(x, a? 2 )][Rot(z , *5*)) (4-4.29) 

r^] = [ Rot(x , a^))[Rot{z, ^)] (4-4.30) 

[ m Ri\ = [Rot(x,aZ)}[Rot(z, 75)]- (4-4.31) 


Transformation matrices in the above equations, an ^ [ m ^ 3 l> 

represent the relative rotation between neighboring local link coordinate sys- 
tems. Thus the orientation of the third link in the first coordinates are given by 
the matrix product 

{ m Rl} = [ m #?][”* f$. (4-4.32) 

For brevity, throughout the subsequent analysis, the following notations axe 

used; =cos(^), s</>™ = sm(<f>™), etc. Then each transformation matrix 

can be written in detail as follows; 

c 7oi c< ^r - sioiC(*?s<t>™ -noM? ~ c<t>? 

sioi c K - ~ s ioi s 4>? - -noi^T 

sa?s<t>? sa?c<f>? ca ? 

(4-4.33) 



[ m Rl\ = 
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0 

r*;-,] = 

CQ Tn-l)n S< t>n 

Ca ?n-1 )n C< i>? 

~ Sa 0i-l)n 


. Sa Tn~ l)n S< t>n 

Sa Tn-l)n C< t>n 

CQ (^-l)n . 


(4-4.34) 


m r>* 

. ^ 3 J — 




0 


—sa 


34 


~ S I 34 

ca S 5 7 3 m 4 ca£c 7 £ 

Noting from the geometry of the shoulder that vectors, s™ for m 


«*£ 


(4-4.35) 


= 1,2,3, are 


fixed to the upper ternary plate, the equation (4-4.27) can be rearranged in 
following form; 


[ m K\ = r ^Kp0*(z, OKI- (4-4.36) 

Now, premultipling [ m ^] r and postmultiplying [ m fl‘] r [ita(z,#J*)] T on both 
sides yields 


rfl!]r«;jrflf](fl<.i( 2 ,* 3 ”)] T = ["*;][*<*(*. °s)i. (4-4.37) 


The orthogonal property of the rotation matrices has been used in the above 
manipulations; that is, the inverse of the orthogonal matrix is equal to the 
transpose of the matrix. In this equation, the last columns of the transformation 
matrices represent the direction cosines of vectors, s™ (1) for m = 1,2,3, with 
respect to the local frame 1. Noting that 


a 


m 

3 


[RirR^Rotiz,^)} 7 


M m *?] 



0 ' 
0 . 
1 , 



n?4 a ~lM ca M «7S sa 34 ' 

f 0 1 

= [a, s t x a t s<] 

~ 5 734 C l34 Ca ™4 H?4 Sa Z 

0 


0 -so 3 m 4 CO'S _ 

1 1 


(4-4.38) 
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vectors, s™, can be obtained by 

*5* = + cr,£ao&8? x«r + ca£<\ (4-4.39) 

Now, let’s define a local coordinate, called dth local frame, as follows 

[ m tf] = [^(^7o”)][^(x,aSl)] 


where 


Note that 


and 


rtfi = 


v m 

/01 


-57mcaSi 

5 7m 5 «ol 

c 7oi CQ oi 

-C7^so5i 

SQ 01 

«*01 

Ocj 

II 

»3 


(4-4.40) 

(4-4.41) 

(4-4.42) 

(4-4.43) 


rtf r = [Rotiz^rrRtf. 

Substituting equations (4-4.42) and (4-4.43) into (4-4.37), and using equation 
(4-4.38), the third column of RHS of the equation (4—4.37), representing local 
unit vectors, can be written as follows 

, 0 ^ 

[flo((z,^)] 7 '»r (d) = rtf;po((z,a£)] i o 


1 


> . 


(4-4.44) 


Now, for brevity, local vectors, s™ (d) for m = 1,2,3, are denoted as 

d'O — 


Sa = 


T m ( d ) ' 
X 3 

y 3 m(d) 


(4-4.45) 


These components can be found in terms of the known parameters in the reverse 
position analysis and are considered as constants in the following analysis. With 
substitution of the equation (4-4.45) into the equation (4-4.44), we have 

*z (d) c<t> T + y? (d) s<t > 7 = (4-4.46) 
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*3 m(d Wr + y™ {d) c4>™ = —ca™ 2 c(f)™ sq” - sa”ca™ 

m(d) 


z 3 = —sa l2 c<t>™ «»23 + caTica 


* 12 ^ 23 * 


(4-4.47) 
(4-4.48) 

Multiply the equation (4-4.47) by -sa™ and the equation (4-4.48) by ca™, and 
add these two results. Then we get 


«*S(*3 + y?c<K) + ca? 2 z? = for m = 1,2,3. 

Substituting the tan-half angle representations into this equations, 

i-m 2 


(4-4.49) 


5 1 + (lm) 2 » and c <t>\ ~ where = tan(^“), (4-4.50) 


yields 


where 


A(t?y + Bt? + C = 0 

^ = y 3 m(1) ^r 2 + ^3 m(1) ca- - ca™ 
B = 2x™ (1) sa™ 

C = -y 3 m(1) ^r 2 + ^3 m(1) c<2 - ca£ 


(4-4.51) 

(4-4.52) 
(4-4.53) 
(4-4.54) 

From this quadratic equation (4-4.51), two solutions can be obtained and they 
represent the two different closures of each serial RRR dyad shown in Figure 


4-5. 


t m — 


-B ± y/m -4 AC 
2A 


(4-4.55) 

The desired angles, (f >? , can be obtained by substituting the results into equation 
(4-4.50) 


<t> |* = 2arctan(t™) 


(4-4.56) 



Figure 4-5 Two closures of the RRR dyad 
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Another joint angular displacements, <j>™ for m = 1,2,3, can be ob- 
tained by back substituting obtained values for into the equation (4—4.46) 
and (4-4.48) 


where 


*" = arctan( ^ ) 

+ yfs<j > ™ 


*4>7 = 


C<t>2 = 


•SQ23 

( (i ) 

ca 12 ca 23 z 3 

soft sag 


(4-4.57) 


(4-4.58) 

(4-4.59) 


Note that in derivation of the kinematic equations for the shoulder, <f %' s of all 
three dyads of the shoulder are not required when the output transformation 
or its equivalent Euler angles are known as in reverse position analysis. In 
particular, for kinesthetic coupling in teleoperator system applications, only the 
first order Kinematic Influence Coefficients(KIC’s) are required. The vectors, 
®i*> «?, and which are required to compute the first order KIC’s of the 
shoulder, can be obtained as follows 

f 0 ) 

s? = [ m RD 


0 

1 


s? = [ m Rl ] \ 0 


0 1 


[ o ) 

0 

> or 8™ = < 

-sa™ 

1 J 


{ ca™ ) 


and 



0 1 

| 

r 0 ' 

»? = • 

0 

> or a™ = < 



l 1 J 

1 

l ca ?3 . 


(4-4.60) 


(4-4.61) 


(4-4.62) 


4-5 Forward position analysis 


Finding the end-effector position/orientation of the manipulator with 
the joint displacement angles measured is referred to as the forward position 
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analysis. In universal teleoperator system applications, whether unilateral or 
bilateral, the handgrip position/orientation of the manual controller must be 
computed and is given as a command to the remote manipulator. In serial 
manipulators, forward position analysis is a relatively simple process. How- 
ever, in parallel manipulators, forward position analysis is an involved process, 
especially when measured joint displacement angles are related to geometrical 
constraints for the desired output position/orientation. For a parallel system 
with measured joint displacement angles along one serial subchain, the forward 
position analysis becomes that for a serial manipulator. In certain cases, the 
locations for position transducers for parallel mechanisms are restricted, due to 
mechanical interferences or requirements for higher resolution. In the following 
section, the forward position analysis of the 3-dof shoulder for three measured 
joint displacement angles, <f> j, <t>\, and <j>\, is presented. With these choices for 
measured joint angles, the above mentioned problems can be avoided. 

From the equation (4-4.27), the following two loop constraints equa- 
tions can be written as, 

otjsmi'js) = r«iir /«■ ™ = 2,3. ( 4 - 5 . 63 ) 

Premultiplying and postmultiplying to equation (4-5.63) yields 

r*;n' fl;ir*y T = r*?K] = r«?) /«• m - 2,3 < 4 - 5 . 64 ) 

where 

i'K) = WKKM- (4-5.65) 

Noting that the local vector, are only a function of the second joint angular 
displacement, the last columns of the above equation (4-5.64) can be used. 
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That is, 
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for m = 2,3. 
(4-5.66) 

The LHS of equation (4-5.66) can be expressed in the following functional form 
in terms of three joint displacement angles {4>\, and di), 

TTTL r%Ol i 1 . e 


/I 1 ) 

8 3 


t ^1)23(^15 

And the R.HS can be written as 



r x m (’> ) 

► = i 

y m(1) 


| z m( 1) J 


form = 2,3. (4-5.67) 


c m (l) 

*3 


S< t>2 S C*n 


-cc&ao&cW - sc&ccZ 3 Mm = 2, 3. (4-5 68) 

l ~ Sa ?2^23^2 + ca^ca^, J 

Multiply -sa™ to the y component and ca£ to the * component of the equations 

(4 5.66) and add those results to obtain the desired constraint equations for the 
shoulder as below 

cq 23 = ~ SQ i2l / m(1) + ca™ 2 z m W for m = 2,3. (4-5.69) 

The equations (4-5.69) may be expressed in more specific form as below, 

+ = W!,tf) (4-5.70) 

D 2{4>\,<j>l,4>\)c(i)\ + El{4\,4>l,4>\)s(f)\ = F 2 (<j>\,<f>\) (4-5.71) 

Note that these constraint equations are functions of two unknown joint angular 
displacements, <f>\ and <f>\ since three joint displacement angles, <f>], <f>\ and <p\ 
are provided. 

From the equations (4-5.70) and (4-5.71), it seems that with either 
<j)\ or <t>\ known, the other variables can be obtained uniquely. However, in real 
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implementation, the measurement errors from the redundant joint such as either 
or <f> 3, is introduced so that both constraint equations may not be satisfied. 
The obtained solutions showed a very high sensitivity to the measurement errors 
and direct substitution of the measured angle, either ^3 or <t>\ into (4-5.70) and 
(4-5.71), resulted in unacceptable results. 

Once joint angles along one of the serial subchains are determined, the 
output transformation matrix of the shoulder system can be computed using 
the equation (4-4.27). Euler angles, fii , H 2 and /i3, representing the output 
rotational transformation matrix of the shoulder, can be also found directly 
from the equations (4-3.9) and (4-4.27) as follows: 


tan Hi = 
tan ^3 = 


s t*2 — { m Rb) 13 

{ m RD 23 / Cfi2 


( m Rlh 3 /cH 2 
-( m Rl)n/cH2 


(4-5.72) 

(4-5.73) 

(4-5.74) 


( m Rl)u/cfi2 ' 

In actual shoulder system implementation, only one set of solutions, 
4>™, where m = 1,2,3, are selected and maintained during its operation. The 
shoulder is not allowed to pass through singularity points to change its config- 
uration (<j)™ = 0°, or 180°), at any time. 


4-5.1 Forward position analysis in explicit form 

In this section, forward position analysis for the same three measured 
joint displacement angles, <f>\, </>j, and <j>\ is derived in explicit form. With 
the direct substitution for the three measured joint displacement angles into 
equations (4-5.70) and (4-5.71), the following form of the equations can be 
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found. 


Dx{<t>\)c<f> \ + EMDsfi = Fi(<j>l) 

(4-5.75) 

D 2 (<f>l)c<p\ -f E 2 {<j>\)s<t>\ = F 2 {4>\) 

(4-5.76) 

Now, applying Cramer’s rule into the above equations, we have 


„x 1 F\E 2 — E\F 2 

02 d x e 2 - e x d 2 

(4-5.77) 

and 


4$. MizllBl 

2 D x E 2 -E x D 2 

(4-5.78) 


Substituting the above results into the trigonometric functions, ( c<f >\ ) 2 -{- ( 5 02 ) 2 = 
1 , yields: 


= (F 1 E 2 - E X F 2 ) 2 + (D X F 2 - F l D 2 f - (D 1 E 2 - E X D 2 ) 2 = 0. (4-5.79) 

Note that this equation is a function of only c<t>\ and s<f>\. When tangent-half 
angle representations are applied 

2 f \ — t 2 A) 1 

s ^3 = c 4>\ = where t = tan(^) (4-5.80) 

they can be written in polynomial forms, 

9(t) = 0- (4-5.81) 

Actually, this equation (4-5.81) is an eighth-order ploynomial, and finding its 
solution would require a major computational effort. Also, the correct solution 
should be selected out of eight possible configurations. Because of those prob- 
l ems ’ this approach for forward position analysis may not be a good approach 
in real time applications. Note that only real solutions of the eighth-order poly- 
nomial equation represent the real possible configurations of the shoulder. 
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4-5.2 Forward position analysis via numerical method 

The explicit form of forward position anlaysis for three measurable 
joint angles, <j>\, 4>\, and <t>\, is computationally intensive and may be difficult to 
achieve in real time as discussed in the previous section. A numerical approach 
for the forward position analysis is considered as an alternative for practical 
implementations. Equations (4-5.70) and (4-5.71) are rewritten in the following 
form for direct numerical application: 


Ci($»*S) = 0 (4-5.82) 

C 2 {<f>\,<t>\) = 0 . (4-5.83) 

To solve the above two nonlinear equations simultaneously, various 
kinds of numerical techniques could be applied. With a simple iterative Newton- 
Raphson’s method, solutions within an acceptable error bound can be obtained 
within two to three iterations. However, both the simulation and actual op- 
eration results revealed that when the initial guesses for the joint angles are 
not sufficiently close to the actual joint angles, the solutions neither converged 
toward the answers quickly nor gave the correct answers. This is expected and 
confirms the existence of the other possible forward position solutions of the 
shoulder for those measured joint displacements as discussed before. 

After obtaining the numerical solutions for <f>\ and <t>\, the remaining 
joint angles, <f >\ , <f>\, <j>\, and <f>\ may be computed. To do so, first, the forward 
position analysis along the one serial sub-chain, of which all joint displacement 
angles are identified in the above numerical method, is performed to find the 
output ternary transformation matrix or its equivalent Euler angles. Then, by 
performing the reverse position analysis along the other two serial sub-chains, 
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the remaining joint displacement angles can be computed. 

4-5.3 Consideration on the location of position transducers 

In the previous sections, it has been shown that the shoulder could 
have multiple possible configurations in the reverse position analysis. Two con- 
figurations exist along each serial sub-chain making eight system configurations 
possible. Likewise, in the forward position analysis of the parallel shoulder sys- 
tem, the number of possible configurations depends on which three measured 
joint angles are chosen. The proper locations of the three position transduc- 
ers are considered shortly. Obviously, the measurement of three joint angles 
along any one serial subchain of the shoulder provides the simplest equations 
for forward position analysis. From the other two serial subchains four possible 
configurations can be obtained (two configurations for each serial subchain). It 
should be noted, however, that the possible mechanical interferences of the po- 
sition transducers in the middle joint with the other links may leave no room 
for transducers at these joints. In the actual hardware design of the shoulder as 
a manual controller, discussed in Chapter 5, the large workspace as well as the 
compactness of the shoulder has been emphasized and not enough room for the 
position transducers is left in the middle joints. Thus the measurements of the 
middle joint displacement angles, <f>\, and <f>\, are not considered. 

The other selections are the three joint angles for actual implementa- 
tion, <f>\, <£[, and <f>\. These selections are most preferable since all of the position 
transducers are placed with the actuators on the base. With high-ratio gear re- 
ducers at the actuators, high resolutions for angular position could be obtained. 
For these three measured joint angles, the detailed analysis is already discussed 
in the section 4-5 and is not repeated. 
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More than three joints angles could be measured among 4> <p\, 
(^ 3 , <f>l, and <f> 3 , as alternatives. Particularly, with any four known joint angles 
including three base joint angles, the forward position solution can be obtained 
without too much computational effort. However, in actual implementation, 
measuring additional joint angles could produce a certain amount of conflicting 
measurement errors, violating the constraints, and thus resulting in an uncertain 
forward position solution. However, the extra joint displacement angle can be 
used as an initial guess to expedite and/or test the numerical calculation. 

4-6 KIC of the parallel spherical 3-dof shoulder 

To analyze multi-loop parallel systems, it is often difficult to obtain 
the kinematic and dynamic model directly with respect to the desired general- 
ized variables. To avoid this kind of difficulty. Freeman and Tesar[32] suggest a 
method using intermediate variables (generalized universal variables). In their 
approach, the kinematic and dynamic model with respect to those intermedi- 
ate variables are found first. Then the desired kinematic and dynamic model 
with respect to the specified variables are computed, using the geometric rela- 
tions between the intermediate variables and the desired variables (called the 
generalized transfer of coordinates). This approach is based on the differen- 
tial equations (holononic equations) and typically the task rate variables such 
as end-effector positional/rotational velocities are selected as intermediate rate 
variables to reduce the computational burden. Note, however, that due to the 
intermediate transformation from the generalized variables to the intermediate 
variables, any mathematical singularities between them would invalidate these 
formulations. 
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To represent the output ternary angular position of the shoulder, the 
Euler angles given in equation (4-3.9) are used. However, the direct time deriva- 
tives of Euler angles do not represent the output ternary differential motion in 
universal Cartesian space. In fact, they rather represent the differential motion 
in joint space that is equivalent to the corresponding Euler angles. If it is re- 
called that Euler angles are defined as succesive rotations with respect to local 
axes, it can be seen that it can be represented the serial wrist with appropriate 
kinematic parameters. That is, 

Rol(x,H\)R0t{y,ii 7 )Rot{z,n 3 ) = i?ot(z,90°).ftof(x,90 0 ) 

Rot{x,^ + 90°)Rot(x,90°)Rot(z, fi 2 + 90°) 
Rot(x, 90°) Rot(z, fiz). (4-6.84) 

In the spherical shoulder system analysis, absolute angular velocities of the out- 
put ternary are chosen as output (intermediate) rate variables. It is also assumed 
that each serial subchain of the shoulder is not in any singularity configurations, 
whether geometrical or mathematical. 

To find the KIC s of the shoulder that relates input joint angular ve- 
locities either to the output ternary absolute angular velocities or to the local 
angular velocities with respect to the local frame fixed on the output ternary, 
use the following relations between the absolute angular velocity and the local 
angular velocity in the local frame fixed on the output ternary. 

w (4-6.85) 

or 

A = [R\] T u 


(4-6.86) 
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where u; = [u>i u 2 w 3 ] r , represents the absolute angular velocity of the upper 
ternary plate and /x = [/ij /i 2 /X 3 ] 7 ', denote the local angular velocity in the local 
frame fixed on the upper ternary plate. 

For each serial subchain, the differential relations between the absolute 
angular velocities, a;, and the joint angular velocities, <f > m , can be written 

u> = for m = 1 , 2, 3. (4-6.87) 

where 

4> m = [4? <k &] T for m = 1,2,3. (4-6.88) 

Note that the superscript, m, denotes the serial subchain; for example, [ m G£] 
represents the first-order KIC between the output rate variables and the joint 
angular velocities of the serial subchain, m. When [ m G£], for m = 1,2,3, are 
not singular, the equation (4-6.87) can be written as 

4> m = for m = 1,2,3. (4-6.89) 

It can be noted that in the above inverse process, the geometric constraints are 
embedded implicitly. Let actuated joint variables be denoted as <f> a =[<f>\ 0j]. 

Then from equation (4-6.89) we have 


4 >\ = [ 1 G>]l; lw 

(4-6.90) 

A = [*g&> 

(4-6.91) 

A = 

(4-6.92) 

where represents the nth row of PGJ] -1 . 

In matrix form, it can be 


k = K.]’’" 


rewritten as 


(4-6.93) 
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where 

KvJ -1 = [ 2 ^,V (4 6.94) 

. . 

Then the KIC is obtained from the equation (4-6.93) 

« = K>„. (4-6.95) 

The local KIC between the absolute angular velocities in the local mov- 
ing frame and the actuated joint velocities can be found by substituting equation 
(4-6.95) into (4-6.86), 

A - (4-6.96) 

where 

[«:.) = W] T KJ- (4-6.97) 

4-7 Static torque analysis 

The KIC matrix, [GJJ], also represents the relation between the input 
torque and the output torque of the system. To find the desired force relations, 
the virtual work principle can be used. The virtual displacement is defined as 
a hypothetical infinitesimal displacement consistent with the applied forces and 
forces of constraints at a given instant. The work done in a virtual displacement 
is called virtual work. The virtual work principle describes the static equilibrium 
state of the system, for which the sum of the virtual work of the forces of 
constraints is zero. It states that the sum of the virtual work done by the 
applied forces to the system is zero, 


SW = Tj • 6(f) + Tl ■ Su = 0, 


(4-7.98) 
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where T+ and T u represent the generalized forces applied to the system at equibil- 
ium. Since the differential displacements from the geometry are related by 

8u = [GflSfa (4-7.99) 

subsitute equation (4-7.99) into (4-7.98) to find 

( T J + TZ\Gl])t<t> = 0, (4-7.100) 

or 

T* = -[ca T r„. (4-7.101) 


4-8 Geometric analysis 

In the previous sections, we obtained the KIC matrices which contain 
the geometric information of the system. In this section, the methods for ge- 
ometric analysis and their results for the shoulder are briefly reviewed. These 
analyses are primarily based on the KIC matrices. Let it represent the general- 
ized output rate variables and <f> the input rate variables. Then the first-order 
differential relation can be written as 

« = (4-8.102) 

Noting that a KIC matrix [G^] is dependent of the displacement variables, ge- 
ometric characteristics of the system can be investigated via the matrix. To 
analyze the KIC matrices, the various properties of the matrices could be uti- 
lized. These include maximum/minimum eigenvalues, determinant, condition 
number, maximum/minimun singular values, etc[9][16][105]. 

By utilizing the norm of the KIC matrix, the input/output bounds 
could be found as follows. Note that 

u T n = ^ t (( g ;] i '[ g ;])^. 


(4-8.103) 
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Dividing the equation (4-8.103) by 4? ■ <f> yields 


*1 • * ^ r (^] T [ g ^])0 

<t> ■ 4> <f> T ■ <f> 


(4-8.104) 


Let Knmi represent the eigenvalues of the matrix, [G^] T [G^]. It 

can be noted that since the matrix, [G£] T [G£], is a real symmetric matrix, its 
eigenvalues are always real. The bound of the equation (4-8.104) can be written 
based on Rayleigh’s principle[86] as 


Ai- < 


2 

mtn — 


MGfFRW < v 


T" 

4> -<t> 


— mar* 


Using equations (4-8.103) and (4-8.105), we have 


(4-8.105) 


A m,nlM| 2 < ||w|| 2 < A^ or ||0|| 2 (4-8.106) 

where || • || 2 — x T ■ x is used. This equation implies that the eigenvalues of 
the matrix, [G^] T ((7^], are directly related to the transmission characteristics 
between the input and output velocities. Note that since the singular values 
of the matrix [<?£], ^minj * • • ^maxj &re the square roots of the eigenvalues of 

[Gincii 

= A„ (4-8.107) 

singular values of [(?£] can be used directly instead of computing the eigenvalues 
of [Gl\ T [Gl\. The computation of singular values are not sensitive to the matrix 
condition and can provide very stable matrix properties. Finding singular values 
are preferable to computing the eigenvalues directly[58]. Note also that the 
r= rank([G^\) nonzero singular values of [G$ and [G“] T are the same. That is, 
the singular values of [Gl) T [Gl\ are the same as [G$[G';j] T . 


m 
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Also for the given bound of the input velocities, another interpretation 
can be made. Let 

\\<f>\\ 2 = j> T ■ j> < 1. (4-8.108) 

The bound of the output velocities could be found using equation (4-8.102) 

£ • 4> = u T {[Gl)[Gl\ T )- x ii < 1. (4-8.109) 

This equation represents the ellipsoid (called manipulability ellipsoid[105] or 
velocity ellipsoid [17]), and the geometrical shapes of this ellipsoid provide the 
velocity bound between input and output;that is, the inverse of the square roots 
of the eigenvalues of ([GjJjfG^] 7 ) -1 represents the principal axes of the ellipsoid. 
This ellipsoid can indicate the transmission characteristics of a manipulator at a 
specific configuration. By examining the inverse of the square root of the max- 
imum/minimum eigenvalues of the matrix(i.e., minimum/ maximum radius of 
the ellipsoid), ([G£][G£] T ) _1 , the information on the maximum/minimum trans- 
mission ratios between the input and the output velocities could be obtained. 

Also the determinant of the matrix can be used to examine transmission 
characteristics. The square root of the determinant of the matrix [G£] T [G£], 
which is a product of all singular values of [G£], is proportional to the area of 
the ellipsoid. The condition number, which is defined as a ratio of the maximum 
eigenvalue to the minimum eigenvalue of a matrix can also be used. The square 
root of the condition number of the matrix [G£] T [G£] (or a ratio of the maximum 
singular value to the minimum singular value of the matrix [GJ£]), represents the 
uniformity of the transmission characteristics at the configuration of interest. 

Now, let’s consider the torque transmission characteristics. Let r and 
/ represent the input and output torque applied to the system. The procedure 
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from the above can be used. Using 


we have 

r T -r = f T iG;][G;} T f. 
Dividing the equation by f T • / yields 


(4-8.110) 


(4-8.111) 


r r • r f T [Gl\[Gl] T f 

JT-J = JT-J • (4-8.112) 

Then the bound of the above expression can be obtained based on Rayleigh’s 
principle as below 


r T • r 

^ min — ~JT~J — ^max' 


(4-8.113) 


By taking inverse of the equation and multiplying r T • r, we get 

^ < |/|* < (4-8,14, 

max A mtn 

where || • || 2 = x T ■ x are used. 

Again, for visual interpretation, we follow a similar procedure as follows. 
For the given bound of input torques, 


||r || 2 = r T -r < 1 , (4-8.115) 

the bound of the output torques could be expressed using equation (4-8.115). 

r T ■ r = / 7 '[g;][g;)’ 7 < i (4-8.116) 

The above equation represents the ellipsoid (called force ellipsoid [17]). For the 
input/output torque transmission bounds, the same analysis for the matrix, 
could be applied. By comparing equation (4-8.109) and (4-8.116), 
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dual relations between the velocity and torque transmission characterisitcs can 
be seen; that is, the maximum/minimum velocity transmission direction repre- 
sents the minimum/maximum torque transmission direction. 

In the previous research on the kinematic design of the shoulder, the 
square roots of both maximum and minimum eigenvalues of the matrix [G£] 
for velocity transmission characteristics between input and output (or maximum 
and minimum singular value of [G^]) are thoroughly examined throughout the 
workspace of the shoulder system to find the optimal kinematic design param- 
eters such as twist angles, and apex angles[68). Figure 4-6 and 4-7 show the 
results from the previous work with the optimal kinematic parameters (i.e., 
qoi = 130°, c*i 2 = 90°, a 23 = 90° and a 34 = 50°). 

The plots containing geometric information of three variables, (i\, /x 2 
and fi 3 , were obtained as follows; 1) for each incremented value of /r 3 , draw 
the contour plot of the square root of maximum/minimum eigenvalues for vary- 
ing /Ltj and /x 2 , 2) then contour plots for each /x 3 are overlayed onto one plot. 
From these plots, the geometric characteristics of the specific shoulder with op- 
timal kinematic parameters can be understood before implementing the actual 
shoulder system. 

However, it should be noted that the above results from the geometric 
analyis is conservative since the Euclidean norm used in the above analysis, || ■ ||, 
does not exactly represent the bound of the actual joint torque and velocity input 
even after with appropriate normalization. Rather, the bound of the actual joint 
torque and velocity can be represented by the infinite norm, || • ||ooi 


| ® || oo = max |x,|. 


(4-8.117) 


: (degrees) 
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4-9 Second order kinematic influence coefficient 

With the direct differentiation of the equation (4—6.95) with respect to 
time, we obtain 

« = (4-9.118) 

where 

^[GJJ = J (4-9.119) 

and 

Ftru l _ d 2 U 

= d^M~' (4-9.120) 

The explicit form or its direct computation of the desired second-order kine- 
matic influence coefficient, [Hfa J, via the above definition, is very difficult and 
complicated. However, one explicit form of both the first-order and second-order 
KIC’s of the shoulder system can be found without difficulty. That is, [G£ a ] in 
explicit form is first obtained, then by direct differentiation of the [G]J ] with 
respect to time, [//*“] could be obtained. That is, 

4> a = [Gt°]u + u T [Htt\ii (4-9.121) 

where 

M = u T [Htz\. (4-9.122) 

Once they are obtained, by direct application of the transfer of coordinates 
methods which are presented in detail in Appendix A, the desired KIC’s with 
respect to specified input variables could be obtained. Also the procedures of 
finding the dynamic model of the parallel system are provided in Appendix A. 
A more detailed derivation can be found in [32]. The detailed derivations for the 
dynamic model of the shoulder system are not included for purposes of brevity. 


CHAPTER 5 


Control Technology for a Force-reflecting Spherical 3-dof Manual 

Controller 


To design a portable, universal force-reflecting manual controller, light 
and compact components are necessary requirements. However, currently avail- 
able motor torque-to- weight ratios are not sufficient for that purpose and in 
any case, the cost of these specialized motors is very high. Hydraulic or pneu- 
matic systems can provide very high transmission ratios but their maintenance 
problems (i.e. working fluid leakages) are major disadvantages. A cable driven 
system is light and has good transmission ratios. However, its low mechanical 
stiffness, low bandwidth, the requirement of more actuators than the desired 
dofs of the system, difficulty in maintenance and calibration, etc., are undesir- 
able. Direct drive motors have an improved torque-to-weight ratio but still their 
direct use in a light-weight portable manual controller is not adequate in terms 
of the required torque-to-weight ratios. 

In this chapter, implementation of an actual universal force-reflecting 
manual controller employing high gear-ratio reducers and its corresponding con- 
trol strategies are discussed. The 3-dof manual controller has parallel geometry. 
The parallel structure allows all three actuators to be located on the base plate 
of the shoulder. Thus the effect of the inertial and gravitational forces of the sys- 
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tem is minimized. With high gear-ratio reducers, the effective motor armature 
inertia and friction on the system are increased and they are directly related to 
the gear ratio used. The increased inertia and friction is reduced or compen- 
sated by utilizing force feedback. That is, the manual controller is electronically 
backdriven. 

It has been shown in the literature that force control can exhibit unsta- 
ble characteristics (i.e, dynamic instability) when the system interacts with the 
environment [4] [5] [24] [25]. For the force- control led manual controller, the human 
arm (as the environment) interacts with the manual controller. The closed loop 
system is required to be stable for those varying human arm characteristics. 1 
Since the human hand’s grip of the manual controller can be characterized as 
a “soft contact”, relatively higher force feedback gain can be applied without 
causing an unstable response by the system. This high force feedback gain 
in a force- controlled manual controller in combination with proper gear-ratio 
reducer-motor combination leads us to the design of a compact and portable 
manual controller. 

A simple single-dof actuator system consisting of the harmonic drive 
reducer and servo-disk motor is described and its simplified linear model is 
derived first. Through the analysis of the linear system model, the effects of 
system components such as the stiffness of the gear train, the sensor stiffness, 
the human arm impedance, and the allowable range of force feedback gain are 
discussed. Force control using either wrist sensing (digital) or joint sensing 
(analog) is applied to an actual one-dof system. The one-dof system uses one 

^or an average adult male, the inertia of the forearm about the elbow is estimated around 
Jh=0.06N — m — sec 2 =8.4 oz — in — sec 2 , the range of stiffness is 1. < Kh < 200 N - m/rad, 
or 140 < Kh < 28000o; - in /rad and the range of the da mping r atio is 0.15 < 0, < 1.5, where 
the damping contant can be obtained by Bh = JhfiCh y/Kh/ Jh)\)\- 
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of the three joint actuator sub-system in the 3-dof shoulder system. Then, 
the implementation of the parallel universal/bilateral, spherical 3-dof manual 
controller system and its hardware/software interfaces are presented. In actual 
implementation, the optimal kinematic parameters of the shoulder as given in 
Table 5-3 are used. The minimum required kinematic equations of the system 
for the force-reflecting manual controller application are also presented in this 
Chapter. 

5-1 Analysis of the one-dof system force control 

In most kinematic and dynamic analyses, systems are assumed to have 
ideal characteristics. That is, backlash, friction, nonlinear/unmodeled dynamic 
effects, cogging, etc. in the system are neglected. However, in practice, those 
effects become significant unless caution is taken in the design and control of 
the system. 



Figure 5-1 Linear second order system with coulomb friction 

Now, consider a linear second-order system with Coulomb friction as 
shown in Figure (5-1). The dynamic equation representing the system can be 
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written as 

Mx + Bi + Kx±pN = F txt + F a (5-1.1) 

where A/, B , A represents the mass, damping constant, and stiffness of the 
system, respectively, and F { txt and F a represents the external force applied to 
the system and the controlled input force, respectively. When the control law, 


F a = KjF ext — K v x — K p x , 


(5-1.2) 


is applied to the above system, the closed loop system can be represented as 


M 

A/ + 1 


x + 


B + A„ 

K i + 1 


x + 


A + A p jiVV 

a j + 1 x =t a7+t 


= A,. 


(5-1.3) 


From this equation, it can be seen that the velocity and position feedback modify 


the damping and stiffness of the system only. However, the force feedback mod- 
ifies not only all the effective system parameters (scaling of the mass, damping 
constant, and stiffness of the system) but also the disturbances(i.e., coulomb 
friction). That is, the force feedback rejects disturbances both from the un- 
modeled dynamics and from uncertainties associated with the task. This force 
feedback control is applied to the manual controller to reduce the inertia and 
friction on the system from the high gear-ratio transmission system. 


In this section, through a one-dof system analysis and its implemen- 
tation, the problems associated with the force control strategies in the manual 
controller applications are examined. In particular, the following aspects are 
considered: 


• The effect of human hand grip of the system, noting that the characteris- 
tics (impedance) of the human arm can vary. 

• The effect of the force feedback gain, which is essentially high gain position 
feedback, and its allowable range without causing instability to the system. 
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• The compensation for non-linear friction. 

• The effect of elasticity in the drive train. 

5 - 1.1 Description of the one-dof system 

The one-dof system shown in Figure 5-2 consists of a 12” link and an 
integrated actuator, which includes a servo-disk motor, an optical incremental 
encoder, an analog tachometer, and a harmonic drive reducer with 60:1 gear 
ratio. For force sensing, a 6-dof wrist force/torque sensor is mounted at the 
handgrip, and a torque strain gauge is attached on the output shaft of the 
harmonic drive reducer. The one-dof system is driven by a PWM amplifier in 
the current mode and controlled by /^VAX II computer. 


Handle 
a F/T sensor 


Figure 5-2 Schematic of a one-dof system 

Harmonic drive gear reducers have very attractive features over the 
other transmission systems such as low backlash, compactness, and high torque- 
to- weight transmission ratio. However, the low stiffness of the system is regarded 
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as its main disadvantage. In the actual harmonic drive system, in addition to 
the expected static friction, the large magnitudes of cogging forces are felt in the 
backdrive mode (i.e., the use of the harmonic drive system as a speed increaser) 
and measured as shown in Figure 5-3. They are believed to arise from non-ideal 
gear contacts and misalignments of the wave generator. This nonlinear friction 
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is very difficult to compensate for. For the one-dof system implementation, the 
unit with the least magnitude of nonlinear varying friction out of three actuator 
systems is used to study the effect of the nonlinear varying friction. 

In the next section, the amplifier-in-current-mode is briefly discussed. 
A design of a low-pass filter is then described. And finally, a simplified linear 
model and its analysis of the one-dof system are presented. 



5—1.2 Amplifier-in-current- mode system model 
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The schematics of a torque controlled system can be represented as 
in Figure 5-4. Its equivalent block diagram is shown in Figure 5-5. A trans- 
fer function between input command voltage and the current applied to the 
armature of the motor can be obtained as 


V d = T^Tr7Tar 0 ' (5 ~ L4) 

and a transfer function between back-emf voltage (regarded as a disturbance 
in current mode) and the current applied to the armature of the motor can be 
written as 

I a 1 

Vemf ~ L a s + R a + ARo (5-L5) 

where 


s:Laplace variable, 

I a : current applied to the armature of the motor, 
Vd : command input voltage signal, 

V em j : back emf. voltage, 

A : voltage amplifier gain, 

L a : armature inductance, 

R a : armature resistance. 

R a : sensing registance 


In the above equations, it is assumed that the mechanical time constant 
is sufficiently larger th:.n the electrical time constant so that the effect of the 
mechanical system dynamics to the electrical system is negligible. Since the gain 
of the voltage amplifier (operational amplifier gain A) is very large, the effect 
of back-emf voltage to the armature current becomes negligible as can be seen 




Figure 5-5 Equivalent current amplifier 
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from equation (5 1.5). The amplier-in-current-mode can be approximated as a 
pure voltage-to-current converter with gain, I< { = 1 / R 0 . That is, 

V d * K '- (5-1.6) 

Note that as the current feedback gain, R a , becomes zero, the above system 
becomes a voltage amplifier. 


5—1.3 Digital filter design 


The general digital filter in the z transform domain can be expressed 
as 


H(z) - Y ^ - V akZ ~ k 

fcji + EL,fe*-* 

(5-1.7) 

m L 

Vn = J2 °kXn-k ~ hy n -k 

k=0 k= 1 

(5-1.8) 


where y n and x n represent current state and output of the system, respectively, 
and the subscript n — k represents the fcth previous state or output. 

In the design of the filter for both the shoulder system and one-dof 
system, the first order Butterworth analog model is used 

H ( 5 ) = YTT (5-1.9) 

where u c is a desired cutoff frequency in the analog model. For the low pass 
filter, using the following bilinear transformation 


5 = JTT (5-i.io) 

the cutoff frequency, w 0 , in actual digital filter design can be found as follows. 
Substituting s = ju a and z = t^ cT into the above bilinear transform equation 
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yields 


or 


e jWcT -\ j sin(u c T/2) ,u f T 

jw a = UTTl = 1 — rTvT = 3 tai H ~o~’ 

t 3^d i cos(u; c i / 2 ) 2 


u a = tan(7r/ n r). 


(5-1.11) 


(5-1.12) 


Where T represents the sampling period and /„ represents the desired cutoff 
frequency, By applying the above bilinear transform into the first order 
Butterworth model equation, we get 


H(z) = 


w 0 




1+U>a 


+ frl 1 + l+w, 


~ -1 


(5-1.13) 


or 




Vn ~ 


1 + CJ a 


%n "1“ 




1 + 


'^n — 1 


U-’a ~ 1 
1 + W a 


J/n- 1 * 


(5-1.14) 


5-1.4 A one-dof system model and its analysis 

The schematics of a one-dof system is given in Figure 5-2 and its sim- 
plified linear model is shown in Figure 5-6. Note that a similar model is used 
in [24] [25] to examine the stability issue on force control. In Figure 5-6, it is 
assumed that a human hand continuously holds the manual controller during 
its operation. In this model, the harmonic drive system is represented as a 
linear spring and damper, the inertia of the motor and wave generator of the 
harmonic drive system is lumped together, and human arm’s characteristics are 
represented as a linear second order system[77]. The inertia of both the arma- 
ture and the wave generator, and the viscous damping constant for the actuator 
system are represented by J a , and J3 0 , respectively. The damping and the stiff- 
ness of the gear train ire represented by B* and K g . The relative damping 
between the actuator and the link is denoted as B g . Note that both the stiffness 
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of the shaft and the structual flexibility of the link are included in K g . The com- 
bined inertia of the link, of the force sensor, and of the handgrip are denoted by 
Ji . The damping and spring constants of the sensor are represented by B, and 
K t . The inertia, damping constant, and spring constant representing the human 
arm’s characteristics are denoted by Jh, Bh, and Kh, respectively. And r a , 0 a , 
and Xh, denote the applied actuator torque, the joint angular displacement, and 
the hand displacement, respectively. 


+ 




Figure 5-6 Simplified linear model of a one-dof system 


Each parameter is converted in its equivalent form with respect to its 
joint angular displacements as shown in Figure 5-6. That is, 

0 Xu 

<=Nr., K = (5-1.15) 

and 

j; = n 2 J a , b : = N 2 B a , k; = n 2 i<„ b; = / 2 b„ r h = j fc , b ; = B h , ic h = K h , 

(5-1.16) 

where N and l represent the physical gear ratio and link length. The dynamic 


equation of the simplified system can be obtained as below 

r; = Jih + B-J: + - 6.) + B„(0i - e.) 


(5-1.17) 
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o = JJ.-K,(e:-e,)-B a (e;-e.) + K;(e,-ex) 

- K) + b;4. (5-U8) 

o = rj- h + e;«; + kx - icje, - r h ) - b-jo, - »;). (5-1.19) 

From the above equations, the following open loop transfer functions can be 
obtained. 


o:(s) 

N 4 (s) 

(5-1.20) 

T a*(^) 

d(»y 

0,(s) 

Nz (s) 

(5-1.21) 

T a(«) 

D(s )’ 

0X(s) 

N 2 (s) 

(5-1.22) 

t;{s) 

D(s)' 


where 

N 4 (s) = (J L S 2 4- ( B g 4 B’ 4 B^)s + K g + K*)(J£s 2 + ( B ’ + B^)s + K * 4- K%) 


~{B*s 4 A';) 2 , (5-1.23) 

N 3 (s) = (J' h s 2 4- (B; + B- h )s 4 I<; + K' h )(B g s + Kg), (5-1.24) 

N *i*) = (B g s + K g )(B;s + K;), (5-1.25) 

D(s) = ( J:s 2 + (B 9 + B; + B;)s + K g )(Jls 2 + (B g + B;)s + K a + K ;) 

(J^ 2 4- (5; 4 3J)a + a:; 4- Kl) 

~(J' h s 2 + (. b ; 4 4 a:; 4 at ;)(^ 5 + A'j 2 

-(^ 2 4 (5; + fl s ) s + at 5 )(5 > + at;) 2 . (5-1.26) 


When the simple proportional force control law as below is applied to the system, 


the contact force measured from a force sensor can be written by 


(5-1.27) 


0, 




< = Kio, - o 9 h ) = icx{~~ - -i) 

T T 

* rt * r§ 


(5-1.28) 
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Note that motion characteristics of the manual controller employing the above 
proportional force control law can be expressed as below by inserting equation 
(5-1.27) into (5— 1.20)-(5— 1.22) as below, 

«:m k n.(s) . , 

UW - *W - ''‘DM’ (W - B) 

rjW-rfW 'W ( ’ 1 

W .. jW ,,,,,, 

»iW - r;( s ) 1 1 D(s) ■ ( 3 1 

Now, by letting r* = 0 in equation (5-1.27) and using (5-1.21), (5-1.22), and 

(5-1.28), the open loop transfer function of the system between the applied 
desired torque and the output contact torque, T 0 , can be obtained as below, 


X — Tc ^ — KfK’( \ ( , 5 _i 39 ) 

M r-M ~ h ‘ K \ ■(,) riW'- (5132) 

The closed loop system characteristics for the different values of force control 


gain, Kj, can be investigated by examining the root locus plot of the above 
open loop transfer function. The general characteristic of the root locus plot for 
the current one-dof system model can be represented as shown in Figure 5-7 
(adapted from [24]). From the figure, it can be seen that as force feedback gain 
increases, the system becomes less stable (i.e., when feedback gain is larger than 
the critical gain value at the crossing point on the imaginary axis). 

The shape of the root locus plot depends on the various system com- 


ponent parameters: that is, actuator, gear train, sensor and task dynamics (i.e., 
human arm parameters associated with manual controller applications). The 
range of force feedback gain that does not cause instability in the system, is of 
interest in this analysis while maintaining desired system bandwidth in manual 
controller applications (5 Hz). In the following, the parametric effect of the 



93 


Table 5-1 System parameters of the one-dof system 


Actuator system 

Total actuator system inertia(J a ) 


Motor damping constant (B*) 

0.34378 lb — in/ (rad/ sec) 

Harmonic drive system 

Gear ratio(iV) 

60:1 

Tortional spring rate(A' s ) 

(0 - 20 % of rated torque) 

23,000 lb — in /radian 

(20 - 100% of rated torque) 

120,000 lb— in/radian 

Damping constant (5’) 

1.85622 lb — inj (rad/ sec) 

F/T 15/50 Sensor Stiffness ^ 

xy linear stiffness(A' J ) 

9680. lb/ in 

z linear stiffness 

30184. Ib/in 

xy rotational stiffness 

27234. lb - inj rad 

z rotational stiffness 

28790. lb — inj rad 

Human forearm 

effective inertia about elbow(J^) 

0.525 lb -in- sec 2 

damping constant(5£) 

21.6 ~ 100.8 lb — in — sec/rad 

stiffness(/^) 

288. ~ 1440 lb — inj rad 

Effective link/sensor/handle inertia(J^) 

1.0946 lb — in — sec 2 


system components in a force-controlled manual controller are discussed, using 
the current system model with the estimated actual system parameters. 

In Table 5-1, system parameters for the actual one-dof system are 
given. 2 The combined linear viscous damping constant for both the motor and 
the harmonic drive system, B* + B*, is estimated to be 2.2 lb — in /(rad /sec). 

J For the torsional spring rate of the harmonic drive system, the value K g — 23000 lb -in /rad 
is used noting that the applied torque does not exceed 20% of the rated torque of the harmonic 
drive system. For the sensor stiffness, K a = 9680/6/in is used noting that the applied torque 
is along the local x direction of F/T sensor frame. The effects of the relative damping of the 
gear train and the sensor damping is neglected; B g = 0. and B, = 0. are used. The length of 
human forearm, 12in, is used. 
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The estimation is based on the following equation, 


T a — t c + (B‘ + B’)uj s , 


(5-1.33) 


That is, from the r a vs. u)„ plot, r c represents intersection point with t 0 axis 
and ( B * -f B * ) represents the slope, T ^~ Tc . Where r c represents the Coulomb 
torque, r 0 applied torque to the system, and u> 33 angular velocity at the steady 
state. However, in the actual system, the nonlinear components such as Coulomb 
friction torque increases the stability bound and a much higher linear viscous 
damping constant than the estimated value could be used in the model when 
certain conditions of the input or disturbances are met (i.e., the results of the 


various kinds of the “describing function” are dependent of the dominant fre- 
quency of both input and disturbance and of their magnitudes) [35] [93]. 

Figure 5-8 shows the Bode plot and the phase plot for the open loop 
transfer function with unit feedback (i.e., Kj— 1) of the current system model. 
In that figure, the tight grip status is assumed. 3 The gear train dynamics of 
this system model shows the resonance around 31 Hz and it is directly related 
to the stability of the system. To reduce its effect, the low pass filter is included 
in the forward closed path. The open loop transfer function of the system with 
the low pass filter is obtained by multiplying 1 /(ts + 1) to the original open 
loop transfer function given in equation (5-1.32). That is, 


<(*) _ TS r/*/ 1 wW 


The following analysis is based on the low pass filtered system model. The cutoff 


frequency of the low pass filter, 5 Hz, is used. 4 


3 For simplicity, human arm impedances are roughly distinguished as soft grip and tight grip. 
The soft grip represents 30% of the tight grip. The tight grip in this analysis is characterized 
roughly a sBJ = 100. lb — in — sec/ rad and J\£ = 1440/6 — in/rad[l]. 

4 see the section 5-1.6. 
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From the Bode plot and the phase plot of the system in Figure 5—9, 
it can be seen that effects of the resonance is reduced to increase the stability 
margin of the system (i.e., positive gain margin and positive phase margin). 
The bandwidth of the system is inevitably decreased. In manual controller 
applications, however, the desired bandwidth (5 Hz [14]) is relatively small and 
the use of the low pass filter is acceptable. 

To investigate the effects of the flexibility of the gear train, the sensor, 
and of human dynamics in force-controlled manual controller applications, pa- 
rameters are varied about the estimated system parameters in Table 5-1. First, 
the human arm characterisitcs are varied. From Figures 5-9 and 5-10, it can be 
seen that a stiffer human arm tends to produce larger positive gain margins of 
the system than softer human arm. As a result, slightly higher force feedback 
gain can be applied to the system but their differences are quite small. How- 
ever, as the stiffness of the human arm is increased further (as with a stiff wall 
contacts which occurs in robotic applications), the stability margin is reduced 
as shown in Figure 5-11. This implies that in manual controller applications of 
force control, a much wider range force feedback gain can be applied to obtain 
the desired system performance (i.e., “power steering” effect). 

For simplicity, only the tight grip condition is considered in the follow- 
ing discussion. As shown in Figure 5-9, the sensor dynamics are relatively fast 
with current model parameters and its effects are almost negligible. When a 
soft sensor is used, which has much slower dynamics them the gear train dynam- 
ics, the system bandwidth is decreased and results in undesirable dynamics as 
shown in Figure 5-12; where the gain margin and phase margin are reduced. 
However, it can be seen in Figure 5-13 that as the gear train stiffness increases, 
the system becomes more stable and that this increased stiffness of the gear 
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Figure 5-7 The general shape of the root locus plot of the current system 
model (Adapted from [ 24 ])- 



Figure 5-8 The bode and phase plot of the current system model with tigh grip 
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Figure 5-9 The bode and phase plot of the low pass filtered (5 Hz) system model 

WITH TIGHT GRIP CONDITION 
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Figure 5-10 The bode and phase plot of a low pass filtered system with soft 


GRIP CONDITION 





98 


train represents the most important system parameters. 

In the above analysis, the form of the characteristic equation of the 
open loop transfer function is assumed to be fixed. However, it can be noted 
that by using inner velocity and position feedback at a faster sampling rate than 
that for the force feedback, the effective system characteristics can be varied. 
The poles of the open loop transfer function of the system can be moved to the 
desired locations if desired. 

In the following, actual experimental results for the one-dof system are 
discussed. In the experiment, the following aspects are investigated; 

• Friction and inertia compensation. 

• Force control performance in manual controller application (electronic 
backdrivability or “power steering”). 

5—1.5 Friction compensation 

In the design of manual controllers, the magnitude of the friction, espe- 
cially Coulomb friction, is an important characteristic to consider. The magni- 
tude of Coulomb friction is directly related to the thresholds for the operator’s 
command forces and to the magnitude of the reflecting forces. To reduce the 
relative magnitude of friction in the system, dither signals of various ranges of 
frequency are applied, but these cause very uncomfortable chattering for the 
operator who holds the system. The dither signal is not considered further in 
this study and regarded as inappropriate for the manual controller application. 

Direct force feedback using force sensing via wrist force sensing (digital) 
has been studied for friction compensation. This scheme is shown to be very 
effective by reducing the magnitude of Coulomb friction down to an average 
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Figure 5-13 The Bode and phase plot of a low pass filtered system model with 

STIFF GEAR TRAIN 

of 0.25/6/ from an average of 1.0/6/ at the handgrip of the one-dof system as 
shown in Figures 5-3 and 5-14. This excellent performance due to friction com- 
pensation also justifies force control implementation to the manual controller. 

However, the harmonic drive system in back drive mode shows a vary- 
ing nonlinear friction in addition to the Coulomb friction. The magnitude of 
the varying nonlinear friction depends on the specific drive unit. This vary- 
ing nonlinear friction could confuse the operator’s feel and reduce the level of 
telepresense drastically. Observing that the varying nonlinear friction of the 
harmonic drive system has a position-dependent characteristic, direct friction 
compensation based on the position- related friction model as given below can 
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Figure 5-14 Static AND VARYING friction of the harmonic drive system in the 

BACK DRIVE MODE AFTER COMPENSATION 


be applied, 


2 7T 


T comp — Slll( . — — — ■ 

I the number of teeth of the flexspline 


+ 0) (5-1.35) 


line ) 

of the harmonic drive system J 

where 0 is adjusted to match the phases of the compensating torque to the actual 
friction. However, it turns out to be ineffective due mainly to the unmodeled 
elasticity of the flexspline of the harmonic drive system. 

In an effort to achieve a better friction/ inertia compensation, another 
force feedback control method using an analog torque inner loop has been imple- 
mented. This feedback control scheme uses an analog signal directly measured 
from the strain gauge attached on the output shaft of the harmonic drive sys- 
tem. The measured signed is directly fed bade to the current amplifier to drive 
the motor as shown in Figure 5-15. When the structural flexibilities of the link 
between the wrist sensor and the joint torque sensor (i.e., strain gauge in this 


102 


case) is negligible, this local force feedback is basically the same as the wrist 
sensed force feedback except it is an analog signal which reduces the digital 
effects (i.e., sampling time delay). As expected, noting that the digital control 
loop sampling frequency is relatively high at 210 Hz and the link of the one-dof 
system is very rigid; the two responses of the digital and analog force feedback 
control schemes showed no significant difference, in terms of the friction/inertia 
compensation. 

The compensation of varying nonlinear friction showed no improvement 
with the above methods. It would be costly in terms of higher quality compo- 
nents and the development of sophisticated control schemes (i.e., adaptive filter, 
etc.) to obtain better compensation for the nonlinear friction. 

5—1.6 Force control implementation on a one-dof system 

The force control is applied to the actual one-dof system. In the ac- 
tual system, high frequency noises are observed as shown in Figure 5-3 and 
5-14. These are believed to come from either the nonideal gear contact or the 
force/torque sensor. To find the proper cutoff frequency of the first-order low- 
pass filter of the wrist sensor, various magnitudes of external forces and various 
cutoff frequency low-pass filters are applied to the system. Through extensive 
trial and error searches and noting that the desired manual controller bandwidth 
is more than 5 Hz, the 5 Hz cutoff frequency is selected to be most appropriate 
for the system. 

For finger contact with the manual controller, no serious noise from 
the F/T sensor is observed. However, the dynamic noise measured by the F/T 
sensor becomes significant when actuator command forces and/or operator’s 
command forces are applied. With the use of the 5 Hz low-pass filter the F/T 



Figure 5-15 Analog inner torque loop diagram 
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sensor noise was reduced significantly. 

Note, however, that the magnitude of human arm jittering becomes 
more significant as the human hand grips the handle of the manual controller 
more tightly as shown in Figure 5-16. These undesired jittering force inputs to 
the force-controlled manual controller need to be filtered out. 

As can be seen in the previous analysis of the simplified one-dof model, 
the system tends to be stabilized with a low-pass filter of lower cutoff frequency 
(below 3 Hz). The higher force feedback gain can be applied without causing 
the instability of the system but its response is too sluggish for the operator due 
to the reduced bandwidth of the system. Also the performance of friction com- 
pensation becomes ineffective. As the cutoff frequency of the filter is increased, 
the stable margin of the system is decreased, which results in a feasible force 
feedback gain that is relatively low. 

The experimental observations are summarized as below. 

1. Without the use of the low pass filter in the closed loop system, the system 
shows instability for very low force feedback gain. This is mainly due to 
the dynamics (i.e., flexibility) of the harmonic drive system. 

2. The cutoff frequency of the first-order low pass filter(5 Hz) is selected 
based on the system component limitations such as human arm jittering, 
sensor noise, resonance of the system, required system bandwidth, etc. 

3. When a low pass filter with relatively higher cutoff frequency is placed 
in the closed control system, the system becomes unstable with relatively 
lower force feedback gain. 

4. Tighter grip of the human hand introduces undesired human jittering into 
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the system as shown in Figure 5-16. 

5. Fairly large force feedback gain {Kj = 3) can be applied to the system 
with the low-pass filter with bHz cutoff frequency. The apparent iner- 
tia/friction of the system can be reduced by l/(K f + 1) times of the actual 
system inertia/friction by using the following control law; 

T a = T ref + K f l(F ref -F op ) (5-1.36) 

where 

T a : actuating control torque, 

Tret : desired reflecting torque, lF re j , 

Fre S : desired reflecting force at handgrip, 

Fop : human command force at handgrip, 

Kj : force feedback gain, 

/ : link length. 


5—1.7 Discussion of the one-dof system experiment 

From the anlaysis and implementation of the one-dof manual controller, 
the performance of force control applied to the manual controller will now be 
discussed. The manual controller which uses the high gear-ratio reducer results 
in a design that is compact and portable. In this particular one-dof system, the 
stable response of the force-controlled system can be obtained with the force 
feedback gain up to Kj =3. This implies the reduction of the inertia and friction 
of the system by 1 /(Kj + 1) times. Also, the effects of the system components 
are discussed using the results of the simplified one-dof system where actual 
estimated values of system parameters tire applied. 
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Figure 5-16 Example of a human operator jittering with soft and hard grip 


In addition to the simple proportional force control law and the first- 
order low pass filter, various control schemes can be applied: PI control, PD 
control, PID control, lead/lag compensation, etc. However, due to the use of the 
high gear-ratio reducer the magnitude of the stiction is fairly large. Thus, any 
integral control law may not be suitable since it may introduce limit cycles [[93]]. 
Also, the integral control tends to destabilize the system by adding a pole at 
the origin and is not considered. 

When the gear train dynamics are negligible, the PD control and lead 
compensator could be used to increase the system bandwidth further. Also, 
as mentioned earlier, by applying proper position and velocity feedbacks, the 
poles of the open loop transfer function can be moved to the desired locations. 
And much higher force feedback gain could be applied to the system to reduce 
the magnitude of both friction and inertia of the system, while maintaining the 
desired bandwidth of the system. These suggestions require further study. 
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5- 2 Integration of the shoulder system 

The main design goal for this system development is an implementa- 
tion of a compact and portable universal force-reflecting 3-dof manual controller 
system with large dextrous working volume and with a somewhat improved 
reflecting-force capability. The implemented parallel 3-dof shoulder system con- 
sists of the shoulder hardware, actuators, a shoulder mounting frame, a 6-dof 
F/T sensor, and a handgrip as shown in Figure 5-17. The manual controller is 
capable of reflecting 50 lb j — in torques about the common intersection point. 6 

To provide the capability of adjusting the impedance of the system, each 
actuated joint contains a servo-disk motor integrated with incremental optical 
encoder and analog tachometer for measuring angular position and velocity. A 

6- dof wrist force/torque sensor (Lord F/T 15/50) is mounted at the handgrip 
(upper ternary) of the system to measure applied human arm command forces. 
Note that with appropriate sensory feedback, the effective system characteristics 
could be adjusted to achieve the desired optimal characteristics of the manual 
controller for varying task characteristics. 

To achieve the desired design criteria in this implementation (such as 
higher torque- to- weight ratio and torque- to-size ratio), each actuator is inte- 
grated with a harmonic drive system with a 60 : 1 gear-ratio. Each actuator 
unit is interfaced with the pulse- width-modulated (PWM) amplifier which is 
set in the current mode so that the current output proportional to the given 
voltage signal could be produced. The command voltage signal comes either 
from the computer via a D/A converter (digital-to-analog converter) or from 

5 Or, with respect to the handgrip of the manual controller, 10 Ibj—in forces along tangential 
direction of the sphere of 5” radius, and 50 lbf-tn torque about the normal axis to the sphere, 
when the handgrip is located 5” from the common intersection point. 
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Figure 5-17 The implemented shoulder system 
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strain gauges directly (analog inner torque loop). The sampling period for the 
force controlled 3-dof manual controller system using a F/T sensor in jtVAX II 
computer was about 45 Hz. 

The hardware interface diagram of the shoulder system is represented in 
Figure 5-18. In the following, hardware design, transducers and their interfaces 
in the force- reflecting manual controller are explained. 
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Figure 5-18 Hardware interface diagram of the shoulder system 
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5-2.1 Digital computer interfaces 

A //VAX II computer is used as the main processor for the control of 
the shoulder system. An A/D board (ADV11-C), three D/A boards (AAV11- 
C), and two parallel interface boards (DRV11-J) are interfaced with the //VAX 
II. An A/D board could be configured to receive 16 single-ended 12-bit channels 
or 8 differential 12-bit channels. It is configured with 16 single-ended channels 
in the bipolar mode to receive an input signal from -10V to +10V. Out of three 
D/A boards, each of which has four channels, only one D/A board is used for this 
purpose; three channels are used to send torque command voltage signals to the 
PWM amplifiers and one is used to reset the encoder counter IC’s. One parallel 
interface board (DRV11-J) is interfaced with the encoder counter circuits and 
the other with the F / T sensor processor. Each board could receive up to 4 sets 
of parallel 16-bit digital inputs. 

5-2.2 Actuator system interfaces 

Each actuator unit of the shouder system consists of a servo-disk motor, 
a harmonic drive reducer, an encoder, and an analog tachometer. Each actuator 
is driven by the PMI VXA 48-8-16 PWM amplifier[73]. 

The servo-disk motor has low electric inductance, low armature iner- 
tia, and has a rotor shaped like a disk with a printed circuit on it. Its main 
chracteristics is summarized as: 1) it has low cogging; 2) it has low electri- 
cal and mechanical time constants; and 3) it has low friction. The harmonic 
drive reducer is also a very compact transmission system and has a very high 
torque-to-weight ratio and low backlash[21]. 

The PWM amplifier provides two control options; velocity mode and 
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current mode[[73j]. In velocity mode, the amplifier behaves as a voltage- to- 
voltage amplifier, and the actuator velocity can be servo controlled since the 
amplifier uses either the tachometer feedback or back emf voltage feedback. 
In current mode, the amplifier behaves as a voltage-to-current amplifier, and 
the actuator torque can be controlled directly. In the control of the shoulder 
system, the current mode for the PWM amplifier is selected to reflect directly 
the desired forces back to the human operator. The bandwidth of the amplifier 
in the current mode is over 500 Hz so that its dynamics can be neglected in this 
manual controller application. 

5-2.3 Encoder and tachometer interfaces 

The incremental encoder generates the two quadrature voltage signals 
which are separated by a 90° phase shift. To decode the encoder output sig- 
nal, a counting circuit utilizing HP HCTL-2016 IC’s and a clocking circuit was 
designed. It was interfaced with the /iVAX II computer via a 16-bit parallel 
interface board (DRV11-J). Since the HP HCTL-2016 IC produces 16 bit data 
through an 8-bit data bus requiring two independent accesses for high and low 
bytes, direct interface with /iVAX II through the parallel interface board is 
difficult [[42]]. However, since the HP HCTL-2016 IC allows us to select the high 
or low byte data, two IC’s are used to read a 16-bit data simultaneously through 
DRVll-J; one IC for the high byte and the other for the low byte. Since the in- 
cremental optical encoder could not provide an absolute joint angle, the counter 
circuit is initialized (reset) via one D/A channel (ADV11-C) when necessary. 

Tachometers generating voltage signal proportional to the angular ve- 
locity are connected to the A/D board (AAV11-C). The diagrams for encoder’s 
circuit, clock, and interfaces to the /iVAX II computer, as well as specifica- 
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tions on encoder, tachometer, and DRV11-J parallel interface board are given 
in Appendix C. 

5—2.4 F /T sensor interfaces 

A 6-dof force/torque sensor system shown in Figure 5-19, consists of 
a F/T sensor hardware and its microprocessor. It provides several options for 
its output. Resolved force/torque output with respect to its local frame could 
be either in ASCII format or in binary format. In binary format, a F/T sensor 
force/ torque output can be interfaced via the serial port (RS-232C) and its 
maximum sampling time could reach up to 100 Hz at 19200 baud rate. The raw 
data from the eight strain gauges could be read via the 16-bit parallel port and 
its maximum sampling rate is 440 Hz. 

To reduce the sampling time during the actual operation of the shoul- 
der, the strain gauge raw data is read directly via the parallel interface board 
(DRV11-J) and is resolved into the force/torque data with respect to its lo- 
cal frame. This resolution is accomplished by postmultiplying the calibration 
matrix to the strain gauge raw data in the /zVAX II computer; 

{ resolved 1 _ 6 by 8 calibration j strain gauge strain gauge 1 

force data j matrix 1 raw data offset ( 

(5-2.37) 

where the calibration matrix (6 by 8) for the F/T 15/50 Lord sensor is provided 
by the Lord company and given in Table 5-2. The sampling time for receiving 
the strain gauge raw data and for resolving those into the 6-dof force/torque in 
local cartesian frame is estimated at around 210 Hz (4.7 msec). 

The detailed interface timing diagrams between F /T sensor and DRVl 1- 
J parallel interface board, and more specifications for the F/T sensor are given 




Figure 5-19 The Lord F/T sensor transducer unit 
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Table 5-2 Calibration matrix for a Lord F/T 15/50 sensor(courtesy of Lord 
Company. 


-.008566 

-.481377 

-.021868 

-.011668 

.030515 

-.484092 

-.007523 

.018417 

.732219 

-.009798 

-.986898 

.015415 

-.016445 

-.002691 

.733218 

.987109 

-.002936 

.025436 

.477910 

.006338 

-.036908 

-.029870 

-.001069 

-.478979 

-.002648 

-.019316 

.729692 

.003892 

1.007737 

.013018 

.005620 

.483959 

-.029810 

-.002368 

-.038984 

-.485869 

.016343 

.005190 

.736930 

-.987992 

.000095 

.011809 

-.478067 

-.009919 

-.016050 

.030900 

.007561 

-.490032 


in Appendix C. Note that command characters to the F/T sensor have been 
sent through the serial port (RS232C) and remained active when the strain 
gauge raw data through the parallel interface board are being received. More 
information can be found in [53]. 

5-2.5 Shoulder hardware design 

The shoulder system hardware consists of an upper ternary, three RRR 
dyads, a lower ternary, and a mounting frame. In the actual design of the 
three dyads, however, mechanical interference is one of main factors limiting the 
working volume of the system. Therefore, the shape of binary links are slightly 
modified to maximize the working volume as shown in Figure 5-20. The working 
volume of the shoulder system is defined, based on the geometric properties 
(i.e., maximum/minimum singular values of the first order KIC) to secure the 
desirable input/output velocity/torque transmission characteristics^. e., cr mm = 
0.2 and cr max = 5.) and can be represented via the following Euler angles[68]; 

Hx = 50°, H2 = 50°, ft3 = 40°. (5-2.38) 

The actual motion range of the shoulder system is far larger than the above 
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given values. However, the geometric characteristics of the shoulder are such 
that some regions could not provide the desired transmission characteristics of 
either the velocities or the torques between input joints and output ternary. The 
more detailed schematic design figures for the whole shoulder system components 
can also be found in [20]. 


5—2.6 Kinematic equations for the shoulder 

From previous research, the optimal geometric parameter values of the 
shoulder system were found based on the input/output transmission character- 
istics of both the velocity and the force/torque as shown in Table 5-3. In the 
actual analysis and implementation of the shoulder system, these parameter 
values are used. Definitions of the parameters can be found in Chapter 4. 

Table 5-3 Optimal geometric parameters of the shoulder 
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As can be seen from the Table 5-3, the optimal geometric parameters 
of the shoulder used in actual implementation happen to have a simple geometry 
(i.e., twist angles for each serial subchain are right angles and edge displacement 
angles are defined to make the system symmetric). Therefore, a set of simplied 
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kimematic equations can be obtained. 

In the forward position analysis, the output transform matrix or its 
equivalent Euler angles(/ij, fi 2 i ^ 3 ) of the shoulder and other joint angular dis- 
placements, 4>™ and <f>\ for m = 1,2, 3, of the implemented system are found as 
follows, given three measured joint angular displacements, <f>™ for m = 1,2,3. 
The same notations defined in Chapter 4 are used in the following analysis. 
The superscript denotes the subchain find the subscript denote the joint. By 
substituting the given geometric parameters for the shoulder into the equation 
(4-5.68), we have 

f s<f>? ' 

* 3 *^ = < 0 ► for m = 2,3. (5-2.39) 

. ~ c< t>2 , 

Noting that the y components of is zero, the constraint equations can be 

found directly from equations (4-5.67) and (4-5.68) as below. 

y m(1) = 0 for m = 2, 3. (5-2.40) 

Solving these two constraint equations via an iterative numerical method (see 
section 4-5.2), <j>\ and can be found. Then, the output transformation matrix 
of the shoulder, f 1 ^], is computed by substituting three joint angular displace- 
ments along one serial subchain # 1 into equation (4-5.65). To compute <j>\ and 
<t> 2 , the equation (4-5.67) is written again, 

f 0 ) ( x m M ) 

*r (1) = r ASPwrMf o U i »" (i > 1 . (5-2.41) 

{ 1 J l J 

From equation (5-2.39) and (5-2.41), <j>™ can be found as follows 

x m (i) 

<f>™ = arctan( — ^y) f or 171 = 2,3. 


(5-2.42) 



118 


The first order KIC’sQG^]) of the shoulder between the absolute an- 
glular velocities of the output coordinates and the actuated three base joint 
angular velocities can be obtained using equations (4-6.90) - (4-6.97). The 
[Gjjj -1 = [G£°] can be obtained in explicit form and are provided as below 


4. = K.]- 1 * 


(5-2.43) 


where 


pc;]- 1 
(c;j- = pG}]- 1 

. i 3g ;ip‘ J 
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The second row components are obtained form the subchain #2, 
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The last row components are obtained from the subchain #3, 
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.3^3 
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s<t > 2 


(5-2.44) 

(5-2.45) 
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2 


»<t > 2 


(5-2.53) 

Then the local KIC’s of the shoulder system can be obtained using equation 
(4-6.97) 

[GU = [Rl) T {Gl J (5-2.54) 

noting that 

[G>J = [CM -1 - (5-2.55) 


Note that as discussed briefly in the Chapter 4, the second-order KIC, [#*“], 
can be obtained directly by differentiating the above explicit expression of [(?*•]. 
Then using the transfer of coordinate methods, any desired second-order KIC’s 
can be obtained as shown in Appendix A. 


5—2.7 Force feedback transformation 

The wrist force/torque sensor is located on the top ternary plate of the 
shoulder system as shown in Figure 5-21. Since the universal output coordinates 
are selected as the local coordinates fixed to the top ternary but having the origin 
at the common intersection point of the nine joint axes of the shoulder system, 
the 6-dof force/torque sensor output (which is represented in its local coordinate 
frame), should be transformed into its equivalent forces in the universal output 
coordinates. 

To find the desired transform equation, denote two independent gen- 
eralized variables for each set of coordinates, fi = [x y z 0 X 0 y 0*] T for univer- 
sal coordinates and fi = [x* y* z* 0* 0’ 0*] T for force/torque sensor coordinates. 
Then the geometric relation can be identified as, 




(5-2.56) 
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Figure 5-21 Local frames of a F/T sensor and a upper ternary plate 


where 

6n = [Sfi x 6fi y 6fi z 80 x se v 69 z ] t , (5-2.57) 

6n- = [Sul 6ft* Sul 80; 80; 80;] T (5-2.58) 


\Gi) = 


1 0 0 
0 1 0 
0 0 1 
0 0 0 
0 0 0 
0 0 0 


0 10 
-LOO 
0 0 0 
1 0 0 
0 1 0 
0 0 1 


(5-2.59) 


In the above equation, L represents the distance between a force/torque sensor 
origin and a common intersection point of the nine axes. The virtual work 
principle implies, 


T T 6fl = T mT 8(x' 


( 5 - 2 . 60 ) 
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where r = [f x f y f z r x r„ t z ] t and r* = [/; /; /; T ; r y * t;] t . Using the equa- 
tion (5-2.59) and (5-2.60) yields 

r = [GJfjV ( 5 - 2 . 61 ) 

However, noting that no translation of the shoulder is allowed, the following 
equations can be directly applied in force/torque transform equations to reduce 
the computational efforts. 

T x = ~Lfy + T* 

T y = Lf: + r; (5-2.62) 

t z = r; 

The torque in active joints driven by the system actuators can now be obtained 

by 

= [6*] T iV (5-2.63) 

5-2.8 Control strategies for the shoulder 

The dynamic equations for the manual controller in joint coordinate 
variables cam be expressed in the following form, 

t. : = [r„\ 4 > + ]* + ig;\ t f v + t, + t, ( 5 - 2 . 64 ) 

where the left hand side(T a ) represents the actuator torque, the first term 

r *gbt hand side represents the effective inertia force of the actua- 
tors and links, the second term (<f> [P^^]</>) represents the Coriolis forces and 
centrifugal forces, the third term ([G r ^] r F op ) is the human operator’s command 
force, the fourth term ( T g ) are the gravitational forces, and the last term (T/) 
are the friction forces. The definitions of dynamic system parameters and the 
general derivation of the dynamic equations for the serial and parallel manipu- 
lator either in joint variables or in operational space variables are provided in 
Appendix A. 
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Since the operating conditions of the manual controller can be typically 
characterized by low speed operations, the effects of nonlinear dynamics such as 
Coriolis and centrifugal forces becomes less significant and is neglected. Only the 
inertial, gravitational, or friction forces are considered. Particularly, since the 
parallel geometry of the shoulder system allows the heavy actuators to be located 
toward or on the grounded base, the effects of those inertial and gravitational 
forces are also minimized. It can be noted that due to the use of the high gear- 
ratio transmission systems, the off-diagonal terms (i.e., inertia coupling terms) in 
the inertia matrix, [J^], become insignificant and only the effects of the inertia 
and friction of the actuators have significant influences on the performance of the 
system. This decoupled system dynamics could simplify its dynamic controller 
design. The decoupled force control law could be applied directly to each joint. 

From those consideration, equation (5-2.64) can be simplied as below; 

Ta = [IU)4> + [G^] T F op + T g + T f (5-2.65) 

The simple proportional force control law using a wrist force/torque 
sensing (non-collocated) is applied to the shoulder system. The simplified block 
diagram representing the implemented control loop is shown in Figure 5-22 and 
the applied force control law is 

T* = T reJ + [G^\ T [Kf](F re j - Fgp) (5-2.66) 

where T a : actuating control torque, 

[(?£] : Jacobian matrix of the shoulder or J 
[Kj] : force control gain matrix, which is diagonal, 

TreJ : desired reflecting torque at joint, or [G£ fFref, 

Fra, : desired reflecting force at handgrip, 

Fop : measured human operator arm command force at handgrip. 
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Substituting equations (5-2.66) into (5-2.65) yields 

F reJ -F op = [I + K f }- 1 [G;)- T ([r H }^ + T g + T f ). (5-2.67) 

This implies that the apparent system characteristics can be modified by the 
force feedback gain matrix [I + Kj\. In actual implementation, the first-order 
low-pass filter is included in the closed system to reduce effects of the high 
frequency noise coming from either the gear-train or force/torque sensor as dis- 
cussed in the previous sections. The complete control flow chart of the controlled 



Figure 5-22 Block diagram of the force-controlled manual controller 


force- reflecting system is given in Figure 5-23. The output variables of the shoul- 
der system are represented as Euler angles as in equation (4-3.9) and its input 
variables are reflecting torques in the moving coordinates fixed on the top plate. 


5-2.9 Shoulder system experiment and discussion 

In general, parallel robotic systems involve a significant amount of com- 
putational burden. However, for the implemented shoulder system, due to its 
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SHOULDER FLOWCHART DIAGRAM AS A MANUAL CONTROLLER 
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Figure 5-23 Flowchart of the force-reflecting manual controller 
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simple kinematic parameters (i.e., twist angles are 0° or 90°) and the location 
of the heavy actuators on the grounded base, the computational burden for the 
system is drastically simplified. The total analytical and computational burden 
is not significant and a relatively simple gravitational compensation scheme is 
required. 

The implemented shoulder system exhibits significant magnitudes of 
friction and inertia forces from the high gear-ratio reducers in the actuator 
modules. The magnitude of static friction in the system is compensated for 
via direct force feedback to a level where the human operator is not disturbed. 
However, nonlinear varying friction coming from either the actuators or non- 
ideal gear contacts of the harmonic drive system is the main disturbance that 
deteriorates the performance of the manual controller. 

As discussed in sections 5.1, various factors such as the gripping status 
of the operator, the elasticity of the gear train(harmonic drive system), the 
magnitude of the varying friction(gear cogging), etc., turn out to be related to 
the potential for instability. 

In the actual system, the magnitude of varying friction of one of three 
acutator systems is significantly larger than the other two actuator systems. 
The uncompensated nonlinear friction of the unit dominates the system behav- 
ior, deteriorating its overall performance. When the decoupled force control 
using joint sensing torque from the strain gauge is applied to each joint, the 
uncompensated nonlinear varying friction of the actuator with largest magni- 
tude of varying nonlinear friction represents undesirable chattering responses 
and dominates the system response. However, with the unit replaced, much 
better system performance can be expected. To avoid undesirable nonlinear 
friction, extreme caution should be made to find units which have acceptable 
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non-linear varying friction when the harmonic drive reducer units are selected 
for manual controller application. 

Through these implementations, the application of the high gear-ratio 
reducers to the manual controller with force feedback control is tested and a 
compact, light-weight force-reflecting manual controller system is designed. Also 
the parallel geometry is effectively utilized for more advanced manual controller 
designs. Some of attractive features of the implemented manual controller are 
summarized as below. 

• By the use of the optimal kinematic parameters as shown in Table 5-3, the 
desired working volume is secured. Also, in the actual hardware design, 
the mechanical interferences are avoided to secure a large dextrous working 
volume. 

• The dynamic effects of the manual controller can be simplified or neglected 
by locating all heavy actuators on the grounded base. 

• The simple proportional control strategy is applied and very effective due 
to the simplified dynamics of the system. With force feedback control, the 
magnitudes of the friction and the apparent system inertia are reduced 
significantly. 

• The gravitational force is minimized. 

• The simple and symmetric kinematic parameters greatly reduces the com- 
putatonal burden. 

• A high mechanical stiffness is obtained. 
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• The redundant position sensors are placed to provide the flexibility for 
emergency or component failure. 

5—2.10 Example of shoulder system teleoperation application 

The 3-dof universal/force-reflecting hand controller is applied to the 
control of the simulated HERMIES III mobile system and of the simulated 7- 
dof CESARm in an obstacle-strewn environment animated on a Silicon Graphics 
Work Station at the University of Texas. This is a preliminary step for the 
actual teleoperation application of the shoulder system to control both the actual 
HERMIES III and CESARm at the Oak-Ridge National Labaratory. 

The position data of the shoulder system (the output Euler angles) 
is provided to the Silicon Graphics Work Station to animate the motion of the 
HERMIES III and the CESARm and in return, the potential forces representing 
the information of the relative distances between the controlled system and 
obstacles are reflected back to the manual controller. In the force- reflecting 
controller, the local force control loop is closed to compensate or to reduce the 
inertia and friction of the system, and the reflecting force is used as a desired 
nominal force as shown in Figure 5-22. The interface diagram for the shoulder- 
Silicon graphic work station is given in Figure 5-24. More detailed descriptions 
on the control of these two systems can be found in [87]. 


Figure 5-24 Interface diagram for shoulder-silicon graphic station 
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CHAPTER 6 


A New Conceptual Design of a 3-dof Spherical Gimbal Module 


Both the serial structure and the parallel structure have advantages 
and disadvantages when applied to robotic systems. The serial structure is ge- 
ometrically simple, compact, and has a large, dextrous workspace. However, 
the cantilever nature of the serial structure exhibits low stiffness and results in 
serious static and/or dynamic deflection find positional errors at the end effec- 
tor of the manipulator under the influence of a large payload. The distributed 
location of actuators throughout manipulator structure may also produce un- 
desirable inertial and gravitational effects which reduce the payload capacity of 
the serial manipulator. 

The parallel structure conceivably provides higher mechanical stiffness 
than the serial structure resulting in decreased end effector deflection. The 
parallel structure allows the actuators to be located at the base of the device. 
However, the kinematic and dynamic complexity, the smaller range of motion, 
etc., reduces the wide application of parallel structures. 

Combining the advantages of both a serial structure and a parallel 
structure, desirable characteristics can be achieved through a hybrid structure. 
A hybrid structure is composed of parallel sub-structures which are linked to- 
gether serially. More detailed comparisons between serial and parallel structures 
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can be found in [19][83]. 

This chapter introduces a new conceptual hybrid (or parallel) spherical 
3-dof system. The description and kinematic analysis is presented in detail. Also 
included is the comparative kinematic analysis on various structural spherical 
3-dof wrists: a parallel spherical 3-dof system (discussed in chapter 5 and 6), 
a serial spherical 3-dof system, and a new hybrid (or parallel) spherical 3-dof 
system. The first order kinematic influence coefficients are used to investigate 
their respective kinematic properties. 

6-1 Kinematic analysis for a conceptual 3-dof gimbal module 

A new conceptual hybrid spherical 3-dof mechanism, a parallel six-bar 
6/? 1 (or it may be represented as RPRRPR) linkage, is shown in Figure 6-1. The 
six joint axes must have a common intersection point to satisfy the geometric 
requirement for spherical motion. The parallel structure of the linkage allows 
two actuators to be placed at the grounded base, thus reducing effective inertia 
and gravitational forces. 

Another new parallel spherical 3-dof mechanism can be conceptualized 
by modifying the 3-dof rotational hybrid device discussed above, or by adding a 
3-dof spherical joint as shown in Figure 6-2. Again all joint axes of the system 
must have a common intersecting point to satisfy the geometric requirement 
for spherical motion. In this configuration, a parallel 3-dof linkage provides 
active 2-dof torque inputs and a spherical joint provides an active one-dof torque 
input. Note that this 3-dof spherical joint can be realized by mounting a one- 

*It may be noted that due to the special geometry used in this system, each translational 
motion along the prismatic joint can be represented as a rotational motion about an equivalent 
rotational axis. The equivalent rotational axis passes through the common intersection point 
and is perpendicular to the translational motion surface. 





Figure 6-1 A conceptual hybrid spherical 3-dof mechanism 



Figure 6-2 A CONCEPTUAL parallel spherical 3-dof mechanism 
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dof actuator on a 2-dof gimbal. Again the parallel structure allows the three 
required actuators to be located on the grounded base. The following sections 
present mobility analyses and the description of the kinematic analyses of the 
new spherical 3-dof mechanisms. 


top plate 



Figure 6-3 Schematics of a conceptual hybrid 3-dof system 


6—1.1 Mobility analysis 

The first step in the conceptual design process is to determine the 
mobilities of the spherical 3-dof mechanisms. The simplified schematics of the 
hybrid and the parallel spherical 3-dof mechanisms are shown in Figure 6-3 
and 6-4. Utilizing the general mobility criterion given in equation (4-1.1), the 
mobility for the hybrid 3-dof mechanism can be checked using the following 
equation: 

9 

M = m{n- 1) - = 3(6 - 1) - (2 x 6) = 3, 

i= 1 


( 6 - 1 . 1 ) 
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subchain 

subchain 



subchain *2 


S : spherical Jotnt 
P . prismatic Joint 
R : revolute Joint 


Figure 6-4 Schematics of a conceptual parallel 3-dof system 
The mobility for the 3-dof parallel mechanism is: 

9 

M = m(n - 1) - = 3(6 - 1) - (2 x 6 + 1 x 0) = 3. (6-1.2) 

v=i 

Note that due to the special geometry, the dimension of maximum output space 
in the above mobility analyses, m = 3, is used. 


6-1.2 Kinematic description 

The parallel spherical 3-dof system is a multi-loop mechanism consisting 
of a base plate, a six-bar linkage (6 R), and a 3-dof spherical joint (S or RRR). 
The system is connected in parallel to the six-bar linkage in a manner necessary 
to generate a spherical 3-dof motion. The base coordinate system (*(,, y b , z b ), 
representing a reference frame, is located at the base plate. The coordinate 
system (se t , y t , z t ), representing the output of the system, is shown in Figure 
6-6. Consider the six-bar linkage, driven from two base joints, providing two- 
dof torque inputs. Without loss of generality and for simplicity, two actuated 
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base joint axes are located perpendicular to each other and coincide with x b 
and y b , respectively, as shown in Figures 6-5 and 6-6. An additional actuated 
revolute joint axis from a spherical joint, which independently provides actuated 
one-dof input torque, coincides with z t . To represent output spherical motion 
of the mechanism, the Euler angles, /x u p 2 , and fi 3 , are chosen so that the Euler 
angles coincide with joint variables of the serial subchain 1. That is fi n for 
n = 1,2,3. The Euler angles define the rotational matrices: 

[^i] = [#(*> Mi)][-ft(y, Hi)][R{z, /x 3 )]. (6-1.3) 

The Euler angle definition with the above coordinate system definition avoid the 
problem of mathematical singularity within the workspace of the mechanism. 
The values of the Euler angles 

- 90° < n x < 90°, -90° < n 2 < 90°, and — 90° < /z 3 < 90°, (6-1.4) 

cause no mechanical singularities of the mechanisms to exist. The joint vari- 
ables are represented as <f>™. The superscript, m, denotes the subchain and the 
subscript, n, denotes the joint of the subchain. 

The conceptual hybrid spherical 3-dof system uses the same six-bar 
linkage (6 R) used in the parallel system. Similar notation and coordinate sys- 
tems are applied to the parallel system as shown in Figure 6-5. The actual 
motion of the 3-dof spherical joint in the parallel system can be arranged to 
satisfy fi n = <j>l for n = 1,2,3 such that both the hybrid system and the parallel 
system may be represented by the same kinematics. The following kinematic 
analysis is based on this premise for consistency. Thus the analysis can be 
applied to both the conceptual parallel mechanism and the conceptual hybrid 
mechanism. 
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Base plate 


3 £ 


lTION of a hybrid system 



Base plate 


Figure 6-6 Kinematic representation of a parallel system 
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6—1.3 Forward position analysis 

The forward position analysis requires the output transformation ma- 
trix or the equivalent Euler angles, given the input joint angles. The following 
analysis assumes that three joint angles, <f >\ , 0j , and <^3 are measured and known 
quantities. It can simply be realized by mounting position transducers at the 
corresponding joints. 

From the geometry, the output vector, z u can be represented in either 


as 


or 


z t = \Rot{x, 4 >\))[Rot{y,<t>\)) 


t t = [Rot{y,<t>\))[Rot{x,<f>\)) 



Where 


and 
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( 6 - 1 . 8 ) 


Equating equations (6-1.5) and (6-1.6) results in the following three constraints 
equations, 

siruj) 2 = sin 4 >\cos<f>\ , (6-1.9) 



138 


sin<j>\cos<j>\ = stn<j >2 , (6-1.10) 

cos(f)\cos<f>l = cos4>\cos<!>\. (6-1.11) 

Noting z t • z t = 1, the following two independent constraint equations can be 
derived from the equations (6-1.9), (6-1.10) and (6-1.11) 

tan <f>l = tan <f>\ cos (6-1.12) 

tan <f>\ = tan <f>\ cos <j>\. (6-1.13) 

Because three joint angular displacements, <f>\, <j>\ and <j>\ are known, only <f>\ 
needs to be computed. From the equation (6-1.13) 

<^>2 = arctan(tan $cos^}). (6-1.14) 

l 

Finally, noting that /i„ = for n = 1,2,3, the desired output transformation 
matrix can be obtained using the equation (6-1.3). 

6—1.4 Reverse position analysis 

In the reverse position analysis, the output transformation matrix or 
its equivalent Euler angles, /x„ for n = 1,2,3, are known and joint angles, <f>\, 
<f>\, and <f> 3, need to be found. Noting <f>\ =<f>„ and fi n = <f>\, for n = 1,2,3, 

and using equation (6-1.3), the three joint angles, <f>\, <j>\, and <f > |, can be found. 

Then by using the equation (6-1.13), 4>\ can be computed from 

(f> j = arctan(tan4>\sec<f>\). (6-1.15) 

6-1.5 The first order kinematic influence coefficient 

As discussed in chapter 4 and 5, the output velocity of the spherical 
motion may be represented with respect to either the local moving body-fixed 
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frame or the global frame. To obtain the first order kinematic influence coeffi- 
cient, which represents the geometric relationship between two independent sets 
of generalized rate variables, the method of the transfer of generalized coordi- 
nates is used [32], 

Let u represent the universal generalized rate variables and <j> represent 
the joint rate variables. The differential relationship between them for the serial 
system can be written using the equation (A-2.8); 


W — [G^4> — [«j 82 8 3 )<t>. 


(6-1.16) 


For the serial subchain m = 1, we have 
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Assuming that the above matrix is invertible (i.e., the system is not at singularity 
point), 


4> l = [«} «2 *3] 


Likewise, for the serial subchain m = 2, we have 
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For the serial subchain m = 3 for the parallel configuration, the differential 
relationship between the universal variables, u, and joint rate variables, <f> can 
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be represented by the equations (6-1.17) and (6-1.18), by considering the fact 
4>\ = 4>\ — /*n for n = 1,2,3. For both the hybrid and the parallel system, 
the inverse of the desired first order kinematic influence coefficients between 
universal rate variables, u, and actuating joint variables, 4> a , can be obtained 
by use of equations from equations (6-1.18) and (6-1.20) as follows: 


<h = [<?**]» = 
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( 6 - 1 . 21 ) 


where actuated joint variables, <j> a , axe denoted by 


4>a ~ [<f>\ <t>\ 4>\] T - 


( 6 - 1 . 22 ) 


By inverting the above equation, we can find the desired KIC matrix from 


■u 



(6-1.23) 
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(6-1.24) 


The KIC matrix between the local moving body-fixed frame and joint input, 
[G£], can also be determined using equation (4-6.97). 


6-2 The first order KIC of a serial wrist 

A serial wrist shown in Figure 6-7 has the same Euler angle repre- 
sentations used for the two other structural mechanisms: hybrid and parallel 
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mechanisms. It is investigated in the following comparative analysis. Note 
that [Rl\= [fl(x,<£i)] [R(y,<f> 2 )][R{z, <f> 3 )}. The first-order KIC of the serial 3-dof 
spherical mechanism can be found using equation (A-2.8) as follows; 

it = [G}]4> (6-2.25) 


where 


[G*] = (*1 *2 * 3 ] = 


1 0 S<f>2 

0 C(f>i —S<j>\C<j>2 

0 S<j) 1 C<f>\C()>2 


(6-2.26) 



6-3 Comparative study on geometric characteristics of various spher- 
ical wrists 

The KIC’s of three different spherical systems has been obtained. This 
section compares the kinematic properties of the three spherical mechanisms. 
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A square root of a condition number of the matrix, can be used to 

examine geometric properties of the three spherical mechanisms. Both minimum 
and maximum transmission characteristics can be reflected using the value of 
the square root. However, as discussed previously, the ratio of the maximum 
singular value to the minimum singular value of [GJJ] represents the square root 
of a condition number of the matrix [G^)[G^] T . Therefore, singular values are 
computed directly and the ratios of the maximum singular value to the min imum 
singular value are used instead. 

In general, one of the most desirable characteristics of the system is to 
achieve uniform input and output velocity /torque transmission characteristics 
in all directions at any configuration of the system, or equivalently to have the 
condition number equal to 1. Since the condition number is always greater 
than or equal to 1 by definition, the large condition number implies nonuniform 
transmission characteristics and is therefore not desirable. 

The plots in Figures 6-8, 6-9 and 6-10 show ratios of the maximum 
singular values to the minimum singular value within the specified workspace 
for the three different mechanisms. Both and p 2 are varied from —85° to 
-85° with /x 3 = 0° fixed. From equations (5-1.24) and (5-1.26), both the serial 
mechanism and the hybrid mechanism have the first-order KIC’s independent of 
the joint variable <f> 3 . Since fi 3 = <f>\, they are also independent of n 3 . Therefore, 
the overall characteristics of both the serial and the hybrid mechanisms can be 
represented by the given three-dimensional surface plots. The workspace with 
desired transmission characteristics may be obtained directly from the three di- 
mensional surface plots by defining the threshold value of the condition number. 
However for the parallel system (shoulder) as explained in chapter 4, three- 
dimensional surface plocs are required to identify the workspace with desirable 
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transmission characteristics for equally separated fiz values (for example, —60°, 
—30°, 0°, 30°, and 60°). For the purposes of this analysis, the accurate size of 
the workspace of the three spherical systems is not a major concern. Instead 
the general properties of the three mechanisms are discussed as followings. 

As illustrated in Figures 6-8 - 6-10, the largest dextrous workspace 
with desired kinematic properties is characteristic of the serial mechanism. Only 
within the relatively small workspace(i.e., —50° < /xj, fi 2 < 50°, —40° < 
\i 3 = 0 < 40°), the parallel system maintains desirable kinematic properties [68]. 
Note that the comparison is based on kinematic properties only. For other 
characteristics such as inertial and gravitational effects and mechanical stiff- 
nesses, the parallel system may indeed be more desireable as contended by many 
researchers[19][52][85]. However, the new conceptual mechanism represents very 
promising properties in both kinematic and dynamic aspects. It has a relatively 
large dextrous workspace as shown in Figure 6-9, and the parallel structure in- 
creases mechanical stiffness. The device also allows most of the actuators to be 
placed toward ground, minimizing inertial and gravitational effects. The simple 
kinematics of the system represent another desirable feature. 

6-4 Discussion and conclusion 

A new conceptual hybrid (or parallel) spherical structure is introduced 
and the kinematic analysis has been presented. To evaluate its geometric charac- 
teristics, the first-order KIC’s of three different spherical systems (serial wrist, 
shoulder, and new spherical wrist) have been compared. The results shows 
that the conceptual system represents better transmission characteristics and/or 
larger dextrous workspace than the parallel dyad shoulder. Also the paral- 
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lei structure provides mechanical stiffness and allows actuators to be placed 
toward ground, minimizing inertial and gravitational effects. The simple kine- 
matics represents another desireable aspect. From these considerations, the new 
spherical system is very promising in both kinematics and dynamics. As a 3- 
dof force-reflecting manual controller, the new spherical system seems to have 
promising features, suet as low inertia and simple kinematics. 

Finally, it should be noted that when <p\ in a hybrid system and in a 
parallel system are constant, either of these systems becomes a two-dof parallel 
system. This type of system permits two actuators to be located at the base 
which is a very desirable feature for a force- reflecting manual controller. In the 
following chapter, a conceptual 6-dof system using the 2-dof parallel system as 
a system component is introduced and analyzed. 
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CHAPTER 7 


Conceptual Design of a Parallel 6-dof Manual Controller 


In the literature, the advantages of parallel geometry in the design of 
the manipulators have been discussed and much effort has been devoted to this 
advanced topic in mechanical design of manipulators [49][52] [61][85] [104] . A 
parallel 6-dof manipulator, the Stewart platform, was first described by Stewart 
and applied to flight simulators [85]. As shown in Figure 7-1, this type of system 
uses actuated prismatic joints and the workspaces is quite limited. Also the 
prismatic actuators are not backdrivable so tasks requiring compliance of the 
manipulator are not feasible. However, due to the higher mechanical stiffness of 
the parallel structure, manipulators with parallel structures have been applied 
to tasks requiring high precision under load. 

The design of the force-reflecting manual controllers requires consid- 
eration of many issues. In the previous chapters, the conceptual design of a 
spherical 3-dof manual controller has been introduced and investigated. In this 
chapter, a design of a 6-dof force-reflecting manual controller is discussed. For 
the design of force-reflecting manual controllers, parallel geometry has been 
applied to the design of the universal 9-string force-reflecting 6-dof manual con- 
troller developed at the University of Texas[3][63]. The structure of this device 
is basically similar to the Stewart platform 6-dof parallel system. 
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In this chapter, a brief description and performance evaluations of the 
9-string force-reflecting manual controller are presented first. Next, one of the 
conceptual force-reflecting manual controllers, which has a parallel structure, is 
analyzed in detail. This conceptual manual controller seems to have advantages 
such as compactness, portability, light-weight, minimum effective inertia, me- 
chanical rigidity, etc. The analysis provides an initial framework to investigate 
the kinematic properties and feasibility as a force-reflecting manual controller 
application of the device. 

7-1 A 9-string force-reflecting 6-dof manual controller 

A 9-string force- reflecting 6-dof manual controller is shown in Figure 
7-2. The system utilizes the similar geometry of the unilateral 9-string 6-dof 
manual controller developed by Tesar et al. at the University of Florida[64]. 
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The design of the 9-string force-reflecting 6-dof manual controller provides the 
desired force-reflection by employing nine actuators to control nine string ten- 
sions. Three constant-pressure air cylinders provide constant compression forces 
which the strings are unable to supply. The actual 9-string force-reflecting 6-dof 
manual controller system is interfaced to a the Cincinnati Milacron T 3 - 726 In- 
dustrial Robot via the VAX II system as shown in Figure 7-3 and 7-4. Various 
system operation modes 1 , including force-reflection, scaling, filtering, resolved 
rate control, resolved position control, etc. have been successfully demonstrated 
at the University of Texas at Austin[63]. 

The dominant features and limitations of the 9-string force-reflecting 
6-dof manual controller are summarized below. The advantages are: 

• 0-10 lb forces and 0-40 in — lb torques can be reflected within the dextrous 
workspace which is defined by a 10 inch diameter of sphere. The larger 
workspace of the manual controller, an 18 inch diameter of sphere, can be 
defined with lower reflecting force capacity. 

• The kinematic analysis requirements(computational burden) is reduced 
due to the use of redundant position transducers (motion of each string is 
measured by a potentiomenter). 

• Due to the use of redundant actuators, nine actuators and three constant- 
pressure air cylinders to control 6-dof reflecting forces, both the magnitude 
of the reflecting- force and the size of the dextrous workspace are increased. 

• The workspace does not contain singularities. 


'see chapter 3 for general background on the teleoperator system 
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Figure 7-2 A 9-string force-reflecting manual controller 
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Figure 7-4 Signal FLOW CHART for universal force-reflecting manual controller 
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• All nine of the actuators are located on the fixed base plate, reducing 
most of the effective inertia and gravitational effects. Cables are used to 
transmit the reflecting forces, making the system virtually massless. 

The limitations are: 

• The volume of the manual controller is rather bulky. 

• Due to the use of the cables, the system is not mechanically stiff. 

• Due to the use of the pneumatic and prismatic cylinders, the system has 
lower bandwidth, and friction from the pneumatic cylinders is significant. 

7-2 Conceptual design of a 6-dof manual controller 

The parallel geometry of the 9- string manual controller exhibits various 
beneficial features as a force-reflecting manual controller. However, most of 
advantages of the parallel structure are not effectively used. For example, it 
is not mechanically stiff and the size is bulky. Conceptual designs of force- 
reflecting manual controllers, which use parallel geometry and exhibit desirable 
design features such as compactness, portability, etc., axe now introduced. 

Based on the Stewart 6-dof system configuration, various parallel force- 
reflecting 6-dof manual controllers may be conceptualized; for example, SPS , 
RRPS, and RRRS , which represent kinematic configurations of each subchain 
of a parallel system. In this study, configurations using the ball and socket joints 
on the top plate are considered for the sake of the simplicity. Because it is not 
easy to find a compact, efficient backdrivable linear actuator with an electric 
drive, configurations using prismatic joints are not considered. 
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Two configurations, which have basically the RRRS and RRRS con- 
figurations, may be conceptualized. A 6-dof parallel system with 3 legs and with 
6 legs are shown in Figures 7-5 and 7-6. A 6-dof parallel system with 6 legs may 
require considerable computational effort. Mechanical interferences among six 
legs may also reduce the size of the workspace considerably. However, a 6-dof 
parallel system with 3 legs can use the conceptual hybrid (or parallel) system 
introduced in the previous chapter as a 2-dof gimbal module at the base. The 
resulting system allows all six actuators, which are required to provide 6-dof 
reflecting forces, to be located at the base. Thus the properties of the system 
which are best suited for a force-reflecting manual controller application are 
maintained. 

7-2.1 Mobility analysis 

The simplified schematic of the 6-dof system is shown in Figure 7-7. 
In the figure, each 2-dof parallel system module is represented as its equivalent 
serial representation, that is, RR. Now, using the general mobility criterion 
given in equation (4-1.1), the mobility of the 6-dof system is 

9 

M = m(n -1)-^u,=6x7-(3x3 + 5x3 + 4x3) = 6. (7-2.1) 

«=i 


7-2.2 Description of the 6-dof bilateral parallel manual controller 
with 3 legs 

The 6-dof manual controller in Figure 7-5 has three legs which connect 
the base and the top plates in parallel. Each leg consists of two parallel actuated 
joints(i?i?) at the base, one passive revolute joint(/2) in the middle of the leg, 
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3 Legged Stewart Platform 



Figure 7-5 A conceptual 6-dof 3-legged Stewart Platform 
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Figure 7-6 A conceptual 6-dof 6-legged Stewart Platform 
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top plate 



subchain *3 


R : revolute joint 
S : spherical Joint 
RR : two-dof joint 
(parallel module) 


Figure 7-7 Schematics OF a conceptual 6-dof system 

and a passive ball and socket joint(S') at the top plate. The three 2-dof actuated 
joints at the base (6 actuators in total) provide 6-dof forces to the top plate. 
Note that this geometry is similar to the 6-dof 9-string force- reflecting man- 
ual controller. However, by not using bulky pneumatic cylinders and wires to 
actuate the manual controller, the three-legged controller provides greater com- 
pactness and higher overall stiffness with less friction than the 9-string manual 
controller. Also, because all six actuators are mounted on the base plate, the 
effects of the effective inertia and gravitational force are minimized. 


7-2.3 Coordinate systems and transformation 

For simplicity and without loss of generality, let the locations of the 
ball and socket joints on the top plate be distributed symmetrically as shown 
in Figure 7-8. The three radii are located in 120° increments on the plate (that 
is? 7 ti = 0°, 7*2 = 120°, and 7*3 = 240°). The locations of the actuated joints 
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on the base plate are arranged in a similar fashion, 7 n = 0, 7 ^ = 120°, and 
763 = 240°. 

The origin of the moving coordinate system ( x t y t z t ) fixed on the top 
plate is defined at the center of the top plate and the axis perpendicular to the 
top plate is defined as the local coordinate axis z t . The reference coordinate 
system (*(, y b Zf,) fixed on the base plate is defined similarly as shown in Figure 
7-8. 

r and R represent the radii of the base and top plates from the origin 
of the moving coordinate system to the center of the ball and socket joints, and 
from the origin of the reference (or global) coorinate system to the common 
intersection point of the hybrid 2-dof gimbal module, respectively. The symbols 
and l™ represent the lengths of the upper link and the lower link, respectively. 
The joint variables of the parallel 2-dof gimbal module are denoted by <f>™ h and 
<f> 2 h • The joint displacement of the middle joint between the lower link and the 
upper link is denoted by <j>™ . With this notation, the superscript denotes the 
subchain and the subscript denotes the joint. 

Also Rt and [/?£] denote the global position vector to the origin of the 
moving coordinate system from the origin of the global frame and transformation 
matrix of the moving coordinate system with respect to the reference coordinate 
system, respectively. The symbols 0 X , 0„, and 0 Z represent Euler angles equiv- 
alent to (#£]. That is, [#$]= [Rot(x,6 x )][Rot(y,0 y )] [Rot(z,0 z )]. Also, r^ m and 
r ctm denote the position vectors from the origin of the moving coordinate system 
to the three contact positions, represented in the moving coordinate frame and 
in the global frame (in this case, in the base frame), respectively. Rf, m denotes 
the global position vector to the common intersection point of the parallel 2-dof 
system from the origin of the global frame. 
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For simplicity in the following analysis, it is assumed that the control 
point coincides with the origin of the moving coordinate system. Also, interme- 
diate variables, 4>™ and <}>™ , are introduced to simplify the kinematic analysis 
where <t>™ and <}>™ represent joint angles for the serial 2-dof system equivalent 
to the hybrid 2-dof gimbal module. Select intermediate variables such that 
K= 4>Th 35 the previous analysis of Chapter 6. 

Initially, the kinematic analysis is performed with respect to the new 
set of joint variables, 4> m = (<f>™ <f>™ (f>™ ) T . Then, using constraint equations given 
in equations (6-1.13) and (6-1.14), the desired kinematic analysis with respect 
to the actual parallel joint variables, 4> m = (<f>™ 4>™ h (f >™) T , is obtained. 


three-dof 1 
ball and socket 
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revolute ^3 
Joint 



two-dof <j> 1 
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joint i 

module 4^ 


Top plate 


Base plate 




Figure 7-8 Kinematic representation of a conceptual 6-dof system 
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7-2.4 Reverse position analysis 

For reverse position analysis, the output position and orientation of the 
system is known and the joint angles 4^, and <f>™) are unknown. Noting 
r^’s and Rim's are fixed constants and may be written as 


= (r, 0 , 0 ), 

(7-2.2) 

r ct2 = ( r cos 7 <2 , r sin 7 ( 2 , 0 ), 

(7-2.3) 

r St 3 = ( r cos 70 , r sin 7 * 3 , 0 ) 

(7-2.4) 

Rbi = ( R , 0 , 0 ), 

(7-2.5) 

Rb 2 = (i?cos7i2, i?sin7fc 2 , 0 ), 

(7-2.6) 

R 63 = (i?cos 7 W , sin 7 w, 0 ). 

(7-2.7) 


The global position vectors to the center of the ball and socket joint on the top 
plate from the origin of the global frame, Rct m , can be represented with respect 
to the moving coordinate system 

Rctm = Rt + [flfckrtm = Rt + Tcim f or m = 1,2, 3, (7-2.8) 


where 

Tctm = for m = 1,2,3. (7-2.9) 

Also 

Rctm = Rbm + hi T + hi?, for m = 1,2,3. (7-2.10) 

Equating equations (7-2.8) and (7-2.10) results in 

Rctm — Rt + rctm ~ Rbm + hi? + hi? f or m = 1,2,3. (7-2.11) 
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The local unit vectors, and l™ for m = 1, 2,3 as shown in Figure 7-8 may be 
found as follows; 


l™ = [Rot(z,i bm )][Rot(x,<p™)}[Rot(y,<j>™)} < 


nbmS<j>2 + SlbmSK c $2 
SlbmS4>2 - C7 bmS<l>T c ^ 

c4>?c<j>? 


and 


(7-2.12) 


/-==[fi0f(z, 7 6m)][^(x,^)][^(y^?)][^(y^3)]{ 0 \ ( 7 " 2 - 13 ) 


where O™ represents the angular displacements about the local y axis from the 
lower link to the upper link in clockwise sense plus 90°. For convenience, define 




(7-2.14) 


Apply this to equation (7-2.13) to find 



c 76m c< ^23 5 76m 5< ^l 5 ^23 

SlbmC4>2Z + nbmSK S< t>72 
-cftsiZ 


V 


(7-2.15) 


For convenience, the index representing subchain identification will be omitted 
unless further clarification is necessary. Substituting equations (7-2.8-7-2.10) 
and (7-2.12-7-2.14) into the equation (7-2.11) yields 


Rctx ~ Rbx — fl(c76-S<^2 + S'fbS^C^) + a 7ft s ^ l s 4>23) ( 7 2.16) 

Rctv ~ Rby = h{sibsfa - c-fbsfacfa) + h(s~f b cfa3 + nbsfasM (7-2.17) 

Rctz — Rbz = fl c ^l c ^2 — f2 c ^l s< ^23- (7-2.18) 
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Multiplying s~f b to equation (7-2.16) and -cr) b to equation (7-2.17) and adding 
the results gives 


s<t>\{l\C(f>2 — 1^s4>23) = ( Rctx — Rbx)sy b — (Rcty — Rb y )cy b . (7-2.19) 


Dividing equation (7-2.18) by (7-2.19) yields 


tan d> ( Rctx *.)** (.Rcty Rby^^lfb 

Rctz — Rbz 

(7-2.20) 

or 

<f)x - arctan ^ ctx ~~ Rbx ^ b ~ ( R «v ~ Rb v )nb 

Rctz — Rbz 

After multipling <r/ b to equation (7-2.16) and sj b to equation (7- 
the results, and manipulating gives 

(7-2.21) 
-2.17), adding 

^ C< t>23 = —l\S(f>2 + ( Rctx — Rbx)c~fb + ( Rcty ~ Rby)s~fb- 

(7-2.22) 

Rearrange the equation (7-2.18) 


w 23 - W 2 ( R «*- Rb *\ 

COS <f>\ 

(7-2.23) 

Squaring equations (7-2.22) and (7-2.23) and adding the results yields 

As<f >2 + Bctp 2 = C 

(7-2.24) 

where 


A (Rctx Rbx'jcyb (Rcty Rby^^^b^ 

(7-2.25) 


B = (Ra •- f"’K (7-2.26) 

COS (Pi ' 


and 


(7-2.27) 
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By substituting the tan-half angle representations, that is, 

, . <t>2 , 2 1 1-f 2 

t = tan — , s<p 2 = , cd>o = . 

2 1 + 1 2 9 1 + t 2 

into the equation (7-2.24), the tan-half angle is obtained 

, _ A ± y/A* T W - C 2 
C + B 

or 


(7-2.28) 


(7-2.29) 


<?l >2 = 2 axctan (t). (7-2.30) 

Two solutions in equation 7-2.29 represent two different closures of the subchain 
shown in Figure 7-9. The joint angle <f> 3 can be obtained by substituting values 
of <f > 2 into equation (7-2.18) as follows 


•S023 — 


Rctz Rbz ~ l\C<i>\C^2 


-hc<t>\ 


Using equation (7-2.14) and (7-2.31), 


, . Rctz ~ Rbz ~ h C(f>i C(f>2 

03 = arcsin — <f> 2 . 

— l 2 C(pi 


(7-2.31) 


(7-2.32) 


Once the desired joint angles, 4% for m,j = 1,2,3, are obtained, the hybrid 
actuated joint angle, </> 2 *,can be found from equation (6-1.15). 


7—2.5 Forward position analysis 

From the geometry, the following two loop equations (6 independent 
equations) with six unknowns can be obtained 

Rea ~ Ren = [JZjKrgJ - r$) (7-2.33) 


and 


R « 3 - -R'” = - r'li). 


(7-2.34) 
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Figure 7-9 Two DIFFERENT CLOSURE of a serial subchain of a conceptual 6-dof 
SYSTEM 

The LHS of the above equations is represented by <f>™ for m = 1,2,3, when <f>T 
and 4>™ h for m = 1,2,3 are known. And the RHS is represented by the desired 
Euler angles 9 m for m = 1,2,3. To solve these equations simultaneously to find 
the desired Euler angles, iterative numerical solutions may be required which is 
not desirable due to the increased computation burden. Therefore, it is assumed 
that the joint angles, #*, <f% h , and <f>% for m = 1,2,3, are measured to simplify 
the forward position analysis. 

Using equation (6-1.14), the equivalent serial joint angles, 4 >™ , can be 
obtained directly. Then using equation (7—2.10), (7—2.12), and (7—2.15), the 
position vectors of contact points on the top plate, f^ctm i for rn 1,2,3, can 
be obtained. Since the control point is located at the center of the equilateral 
triangle formed by three ball and socket joints, the control point position vector, 
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Rt, can be found by 

Rt = g (-Rcti + Rct2 + Rct3) (7-2.35) 

and the direction cosine of the output transformation, [/?£] = [x y z], can be 
obtained as follows; 


_ Ren ” Rt 

\Rca ~ -Rtl 

(7-2.36) 

Rct2 ~ Rct3 

(7-2.37) 

|-Rct2 — -Real 

z = x x y 

(7-2.38) 


7—2.6 First order KIC derivation 

Let u denote the universal output displacement vector, 

u = (x t y t z t 0 X 0 y 0 Z ) T . (7-2.39) 

To simplify the analysis, the intermediate variables, c, representing three ball 
and socket joint variables are defined as below; 

C = (Cl C 2 C 3 ) T ~ (x c ti y ct \ Z ci I X ci 2 y c t2 z ct2 x ct3 Vct3 Zct3) T ' (7-2.40) 

By differentiating equation (7-2.8) with respect to time, the following relations 
can be obtained; 

Cm = Rt + = Rt + ^( r ctm ) for m = 1,2,3 (7-2.41) 

where 

dm = {^ctm i/ctm Z c tm ) • (7—2.42) 

And it can be rewritten as 


c„ = jR, + u x r ctm for m = 1,2,3, 


(7-2.43) 
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where uj represents the absolute angular velocity of the top plate (or moving 
frame) 

u = (w, UJ V u z ) T (7-2.44) 

and 

Rt = (x t y t z t ) T ■ (7-2.45) 

Again, the equation (7-2.43) can be written as follows 

c = [G c u ]u (7-2.46) 

where 

■ ' 

K] = (7-2.47) 

l < 3 Gi) J 

and 

10 0 0 1'dmz T ctmy 

[ ^u] “ 0 10 r ctmz 0 r ctmx } W TTl = 1,2,3. (7— 2.48) 

.00 1 T ctmy T ctmx 0 

In the above equation, it represents 

it = (x t y t z t u x u> v l> z ) t (7-2.49) 

and the components of r ctm as below is substituted into the equation, 

^*cfm (l * ctmx T ctmy ^'ctmz ) • (7—2.50) 

Now, to find the differential relations between joint rate variables and 
intermediate variables, we differentiate equation (7-2.10) with respect time for 
each subchain to find 


c m = [ m G%)4> m /or m = 1,2,3. 


(7-2.51) 
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where 



£ 

£^ 

II 

£ 

(7-2.52) 


[G*]l;l = hsibC<f>\C<t> 2 ~ hsibC4>iS<t>23 

(7-2.53) 


2 = fl(C7 bC<i>2 - SUbSfasfa) - h{ClbS<f>23 + S^sfacfai) 

(7-2.54) 


= -/ 2 (c7fc5<^23 + S^ x s4> x c<f>23) 

(7-2.55) 


= -llCy b C<f>iC<j>2 + l2<nbC<f>\S(f>23 

(7-2.56) 


2 = h{»lbC<t >2 + Cr/bS<t>lS<t> 2 ) - h{s~fbs4>23 - C7fcS«/>iC<?!>23) 

(7-2.57) 


\G%) 2;3 = -h(*Tb*fa& - C^is4>iC<f>23) 

(7-2.58) 


[C^,]3;l = ~h s 4 > l c 4 > 2 + l2S<j>\S<i>23 

(7-2.59) 


(G'5>]3;2 = —Uc<t>\S<f>2 ~ hc4>lC<f>23 

(7-2.60) 


[^]3;3 = ~h c 4>l c< t>23 

(7-2.61) 


Note that in the above equation, the superscript, m, is omitted for convenience. 

To find the first-order KIC between hybrid input variables, 

<f> 2 h <f> 3 L ) T , and intermediate variables, c m , for each subchain, as in 


Cm = 


(7-2.62) 


differentiate the equation (6-1.13) with respect to time to find 

• 0 • cos d > i cos 2 So ■ 

4*2 = cos 2 <f >2 tan (f> 2 h sin ^-1 <f> x -\ — — <f> 2 h ■ (7-2.63) 

COS 2 <f>2h 

Substituting this result into equation (7-2.51) yields the desired [ m Cr£j. As- 
suming that [ m G£j is not singular, take the inverse of [ m G£j in (7-2.62) to 
obtain 

K = [ m GMc m for m = 1,2,3. (7-2.64) 
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Combining the three equations obtained from each subchain and noting equation 
(7-2.40) we have 

4>h = (<t>\ 4>l <(>l) T = [G+^c (7-2.65) 

[ PGf'*] 0 0 ‘ 

[Gi h ] = 0 PGM 0 (7-2.66) 

0 0 PGM 

From this equation, by selecting corresponding rows to actuated joints (i.e., 
4>\h 4>\ <f> 2 h 4>\ 4>lh ) T ), the following equations can be obtained, 

<t>a = [G'Mc. (7-2.67) 

Substituting equation (7-2.46) into this equation yields 

<t>a = [G+‘)c = [GM[Gt]« = [GM«. (7-2.68) 

Finally, for nonsingular [G$°], the desired first order KIC can be found as in 

« = [G* (7-2.69) 

where 

RJ = (7-2.70) 

7—2.7 Kinematic properties and workspace determination 

This section investgates the first-order KIC of a conceptual 6-dof mech- 
anism. The geometrical properties of the system are studied. To examine the 
geometric properties, the ratio of maximum- to- minimum singular values of the 
first-order KIC, can use< ^ as Chapter 6. However, unlike the 

pure rotational system or the pure translational system, the general special mo- 
tion involves both the translational and the rotational motions. The differential 
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equations in (7-2.69) can be rewritten as 


1 17 }- 

■ Cr ' 

l w J 

G ]k 


4> a - 


( 7 - 2 . 71 ) 


When the translational motion and the rotational motion are investigated sep- 
arately as below 7 , the result does not represent general 6-dof motion character- 
istics. That is, singular values of the decoupled translational and rotational 
motion satisfy the following conditions, 

0 




0 


), *i( 


G)k j 


since 


) < max<r([G“J) for i = 1,2,... 6 
\fv^v + UJ T U> 


ll[^J|| = max- 
11 [Gp II = max 

ll[Gj*]|| = max 


Ml 

Vv T v 

w 

“CX 


where 


and 


v 

u? 

V 

u; 


G b 


0 

Gjk 


<p a 


<t>*. 


(7-2.72) 

(7-2.73) 

(7-2.74) 

(7-2.75) 

(7-2.76) 

(7-2.77) 


In order to treat the translation and the rotation simultaneously, the 
ratio of the nominal value of the translational velocity to the nominal value 
of the rotational velocity ( v 0 /u 0 ) are introduced into the equation (7-2.71) to 
obtain 

r „ i r n l . 

<t>a 


J v \- 


l J 

J 


(7-2.78) 
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where 

u>* = — w. (7-2.79) 

This equation implies that when the condition number of the normalized matrix 
becomes 1, the ratio of the output translational velocity to the output angular 
velocity becomes v 0 /ui 0 , with any given input joint velocity bound. 

Now, consider the KIC in terms of the torque transmission characteris- 
tics. The relations representing the input and the output torque can be written 
as 

(7-2.80) 




(7-2.81) 


Normalize the above KIC with respect to the desired output ratios of the force 
and the torque (/ uo /r uo ). Then, the KIC can be rewritten as 


T = [Gp ( f : 

JUO l 7 U 


where 


r * _ J JH T 

1 XL # ti* 

Tuo 


(7-2.82) 


(7-2.83) 


Again, when the normalized KIC has the condition number close to 1, the 
desired ratio of the output force and the output torque can be achieved. It can 
be noted from equations (7-2.78) and (7-2.82) that the dual relation between 
velocity and torque exists. Depending on the application requirements, the 
desired velocity ratios ( v 0 /u 0 ) or the desired torque ratio ratio (/ uo /t uo ) can be 


selected accordingly. 

For the design of the force-reflecting manual controller, once the ratio 
of nominal values for the translational and rotational velocities can be selected 
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based on the desired output ot the translation and rotation, the optimal system 
parameters can be searched which make the condition number of the normalized 
KIC close to l. 2 When the ratio of the torque (f uo / T uo) is based on the desired 
force-reflecting capability, the required actuator torques could be minimized. 3 

By investigating ratios of maximum- to-minimum singular values of the 
above normalized first-order KIC, the workspace of the system, which has de- 
sirable velocity or torque transmission characteristics, can be searched and de- 
termined. This process is a very involved due to the large number of the system 
parameters: that is, geometric parameters (such as the link lengths, radii R and 
r) and the components of the six dimensional motion variables (i.e., tt). For 
the system with normalized system parameters (i.e., = 1, R = 1, r = 1, for 

m = 1,2,3, n = 1,2) and with the fixed output orientation of the top plate, 
the contour plots and surface plots (3-dimensional) are shown in Figures 7-10 
and 7—11, and Figures 7-12 and 7-13. The Figures 7-10 and 7-11 represent the 
y - z plane at x = 0, and the Figures 7-12 and 7-13 represent the x - y plane 
at z = 1.5. Note that in the above plots, the desired output ratio, 1, whether 
for velocity ratio or for torque ratio, is used: that is, the singular values of the 
original first order KIC [G^] is directly investigated. 

2 For example, based on rough dextrous human motion of the human arm, v a = 40 in/ sec 
and u> 0 = 6 rad/sec can be used. 

3 For example, the average values of force range of the human right arm in an aircraft 
control stick, 15.5'’ in front of seated subject, are: 

• 96.3, 83.3 lb for pushing, pulling, 

• 38., 29. /6 for force to left, right, 

• 1.09 lb — ft for maximum torque on a 2” diameter knob. [74] 
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Figure 7-13 CONTOUR PLOTS IN X-Y PLANE OF THE 6-DOF STEWART PLATFORM 
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7-3 Discussion and conclusion 

The new conceptual hybrid system introduced in chapter 6 is integrated 
into a conceptual design of a parallel 6-dof manual controller and the kinematic 
analysis has been presented. In this study, only initial work has been done to 
investigate geometric characteristics of the system and one design method for a 
general 6-dof system is suggested. For a normalized set of system parameters, 
representative contour plots are provided and they show promises. However, the 
conceptual 6-dof system needs to be investigated further; that is, the optimal 
kinematic parameters need to be more fully understood in terms of the geometric 
characteristics for a force-reflecting manual controller application. 

The spherical 3-dof parallel system may be combined with the 6-dof 
manual controller shown in Figure 7-14 to represent a multi-functional test-bed 
of a 9-dof system. The redundant degrees of freedom permits secondary objec- 
tives (singularity avoidance, power minimization, optimal transmission charac- 
teristics, etc.) and requires further research for the manual controller applica- 
tion. Also the use of the redundant actuators, as shown in a 9-string manual 
controller, increases workspace with desired torque transmission characteristics 
and also requires further study. 
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6 DOF, 3 Legged 6 Actuators 

Stewart Platform 


Figure 7-14 A CONCEPTUAL 9-dof redundant manual controller 




CHAPTER 8 


Conclusions and Recommendations 


Most of the available manual controllers in bilateral or force- reflecting 
teleoperator systems can be characterized by their bulky size, heavy weight, high 
costs, or lack of smoothness and transparency, and elementary architecture. 

In this effort, the design issues for manual controllers for advanced tele- 
operator systems are discussed in Chapter 2. The previous design work and the 
general background on teleoperator system are reviewed in Chapter 3. Also, 
existing control strategies and computer supporting functions are reviewed. By 
means of this review, design criteria such as compactness, light-weight, porta- 
bility, force- reflection, etc., in universal manual controllers are listed as most 
important issues. In this research, the design and control of the manual con- 
troller which meets those characteristics are studied and evaluated in an actual 
demonstration manual controller. 

Force control strategies are studied through a one-dof system imple- 
mentation to investigate its performance to the force-reflecting manual con- 
troller in Chapter 5. The desired characteristics of the system components in 
force- controlled manual controller applications are briefly evaluated in terms of 
a simple linear one-dof system model. In particular, from the model (i.e., from 
the Bode plot and phas*= plot) it can be seen that the flexibility of the gear train 
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system is not desirable for force-controlled manual controller applications and 
that a low pass filter reduces undesirable effect of the gear train flexibility. 

A demonstration force- reflecting, 3-dof spherical manual controller is 
analyzed, designed and implemented as described in Chapter 4 and 5. The 
system has a parallel geometry to place all of actuators on the base plate, re- 
ducing dynamic effect of the actuators. To achieve an improved level of design 
to meet criteria such as compactness, portability (light weight) and a somewhat 
enhanced force-reflecting capability, the demonstration manual controller em- 
ploys high gear-ratio reducers and is force- controlled using wrist sensed forces. 
The implemented manual controller is capable of reflecting 50 in — lb j torque 
about the common intersection point of all joint axes of the shoulder. The force- 
reflecting controller runs at 45 Hz in a /xV AX computer and has been successfully 
applied to the control of an animated HERMIES model and an CESARm model 
(of ORNL) on a Silicon Graphics workstation. 

As an alternative design for the spherical 3-dof manual controller, a 
new conceptual hybrid (or parallel) spherical 3-dof gimbal module system is 
introduced with a full kinematic analysis in Chapter 6. Also the resulting kine- 
matic properties are compared to those of other typical spherical 3-dof systems. 
The new system is very promising both in its kinematics and in its dynamics. 
Kinematically, it is simple to reduce the computational complexity and has a 
relatively large dextrous workspace compared to the purely parallel spherical 
system. Dynamically, due to the use of the parallel geometry, all of the actua- 
tors can be placed near the base plate, reducing the inertial and gravitational 
effects. Also much higher mechanical stiffness can be expected. 

As a framework for an enhanced universal force-reflecting 6-dof manual 
controller development, a 9-string force- reflecting 6-dof manual controller de- 
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scribed in Chapter 7 has been implemented and interfaced with the Cincinnati 
Milacron T 3 -726 Industrial Manipulator. The manual controller used a parallel 
mechanical structure and employed redundant actuators (i.e., 9 actuators and 
three constant air pressure cylinders). The force-reflecting manual controller can 
be either position-controlled or velocity-controlled. Also, computer supporting 
functions such as filtering, scaling, etc., have been implemented. However, the 
overall bulky size of this manual controller is regarded as one of its disadvan- 
tages. 

The various 6 to 9-dof test-bed manual controllers are conceptualized 
in Chapter 7. These manual controllers are the Stewart Platform which uses 
only revolute joints. In particular, when the new spherical gimbal module, as 
introduced in Chapter 6, is added to a conceptual design of a parallel 6-dof 
3-legged manual controller, the system becomes a versatile test-bed for force- 
reflecting manual controller evaluation for enhanced human performance. In 
this work, only a design framework such as position analysis and first-order 
kinematic analysis has been presented to investigate geometric characteristics of 
the system. The geometric properties of the system with normalized geometric 
parameters are also presented. 

The modeling approach for serial or parallel linkages is briefly reviewed 
in Appendix A. Those modeling formulations are used throughout this study. 
The various kinematic transformations required in the universal teleoperator 
system operations are reviewed and one method for scaling for the rotation is 
suggested in Appendix B. 

The remarks and conclusions of this effort can be summarized below. 

• A review of current literature and our own laboratory development has 
been presented in Chapters 2 and 3. This review has lead to the identi- 
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fication of the most important design and control issues. Design criteria 
such as compactness, light-weight, portability, force-reflection, and others 
have been considered in these chapters. (See Section 2.3.) 

• The application of force control to a manual controller system for enhanced 
performance has been studied in Section 5.1. In particular, a simplified 
linear model (i.e., from the Bode plot and phase plot) shows the flexibility 
of the gear train system is detrimental to force-controlled manual controller 
applications. A low pass filter reduces the undesirable effect of the gear 
train flexibility giving the overall system greater stability. (See Section 
5.1.4.) 

• A force-reflecting, 3-dof, spherical, demonstration, manual controller has 
been implemented in Section 5.2. The manual controller is a test-bed to 
investigate the effectiveness of a parallel structure in a manual controller 
application. It also allows a performance evaluation of a force- controlled 
manual controller. This manual controller has been sucessfully applied 
to the control of an animated HERMIES model and CESARm model (of 
ORNL) on a Silicon Graphics workstation. 

• Various 3-dof structural design architectures for manual controllers have 
been investigated: serial, hybrid, an parallel wrists. The new hybrid (or 
parallel) mechanism, as introduced in Section 6.1, showed excellent kine- 
matic and dynamic charateristics compared to the other mechanisms. (See 
Section 6.3 for the comparisons.) 

• As a frame work for the development of an enhanced, general, force- 
reflecting, 6-dof manual controller, a 9-string universal force- reflecting 
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manual controller, with a parallel structure, has been implemented and 
interfaced with the Cincinnati Milacron T' 3 -726 industrial manipulator as 
discussed in Section 7.1. The operational software that provides such fea- 
tures as position control, velocity control, filtering, scaling, etc., has been 
developed and implemented to the teleoperator system. 

• Various 6-dof to 9-dof test-bed manual controllers have been conceptu- 
alized in Section 7.2. The most promising design conceptualized is a 3- 
legged, 6-dof manual controller. This design provides an excellent com- 
bination of force reflection, compactness, portability, etc. A preliminary 
analysis of the first order geometric properties of the mechanism has been 
completed using normalized geometric parameters. Further investigation 
will be required to identify the optimal parameters for enhanced design 
for a force- reflecting manual controller. 

In this study, the design and control of the force-reflecting manual con- 
troller has been the major objectives of the research. In most available bilateral 
control or force-reflecting control strategies in teleoperation, the manual con- 
troller regulates the motion of the remote manipulator by providing the motion 
command. It reflects the contact forces experienced by the remote manipulator 
back to the human operator. However, when the remote manipulator makes con- 
tact with the environment, direct force command may be more useful than direct 
motion command. In other words, the command contact forces are provided to 
the remote manipulator from the manual controller and in return, the man- 
ual controller reflects the current motion of the remote manipulator to provide 
kinesthetic feeling. This control strategy has an inverted information flow from 
the acceptedforce- reflecting teleoperator system. This inverse communication- 



179 


command scenario needs to be investigated further for its application and its 
performance in teleoperation. 

Also the application of both redundancy in degrees of freedom as in a 
9-dof test-bed manual controller and redundancy in actuators within the manual 
controller design as in the 9- string manual controller should be investigated fur- 
ther. The extra degrees of freedom can be used to achieve secondary objectives 
such as dexterity, joint torque minimization, etc. of the manual controller. The 
extra actuators can increase the dextrous working volume that has better torque 
transmission characteristics. The application for these two features and their 
effect on the manual controller system requires further study for more enchanced 
manual controller system performance. 



APPENDIX A 


Kinematic and Dynamic Modeling of Serial Manipulators 


In this section, a brief review of the kinematic representation and mod- 
eling and dynamic modeling of the serial and parallel manipulators is given. 
These modeling approaches for serial manipulators are developed by Thomas 
and Tesar, and later extended for parallel manipulators by Freeman and Tesar. 
They are used in the analysis of the various systems in the previous chapters. 
More details can be found in [32] [92]. 

A-l Kinematic representation, coordinate systems of the serial ma- 
nipulator 

Serial manipulators are represented kinematically as a sequence of rigid 
links joined by one-dof lower pair connectors(revolute joints(R) and primatic 
joints(P)) as shown in Figure A-l, without any loss of generality since the other 
lower pair connectors can be represented as combinations of the revolute and 
prismatic joints. Now, 5 ; (or Sjj) denotes the offset distance along the joint 
axis, Sj, between the two links that the joint connects; and 6 3 (ot 9 a) denotes 
the relative rotation about s 3 between these two links. For each joint j, one of 
these dimensions has a fixed value(denoted by double subscripts) and the other 
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is the input reference parameter for the joint. The link jk connecting successive 
joints j and k is defined by the fixed geometric parameters aj k , which is the 
perpendicular distance between the joint axes (measured along the common 
perpendicular a,*), and a jk , the twist angle between the axes measured in a 
right-hand sense about a }k . As shown in Figure A-l, a fixed cartesian reference 
system (x, y, z) is located with the z axis directed along the first joint axis, «j. 
The geometric parameters for the first joint are measured with respect to the x 
axis, which is chosen arbitrarily (except that it intersects 8\ at right angles). 

The position of the body in space is uniquely defined by the orientation 
of the body and the position coordinates of some point fixed in the body. The 
orientation of each link can be defined by the two vectors, 8j and a,j k . These 
two vectors, representing the joint and link axes, form the basis for a body fixed 
cartesian reference system(a;b\ y(i) j z (i)) with the x^ axis lying along aj k and 
along 8j. The superscript in parentheses indicates a vector in body-fixed 
coordinates. Then the rotational matrix, which relates the jth body-fixed frame 
to a coordinate system with the same origin but with axes parallel to the fixed 
reference axes, can be represented 

[Ri\ = x a jk 8j]. (A— 1.1) 

Note that p = where p and p^ are the position vectors of a point P 

from the origin of the jth body-fixed frame represented in absolute and body- 
fixed (j) references. The absolute position of a point P in reference frame can 
be obtained 

P = R j + [Ri]P {j) (A-l .2) 

where P and P^ are the positions of a point represented in absolute and body- 
fixed^) references, and R } represents the position vector of the origin of the jth 
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body-fixed coordinate from the fixed reference. The position vector, can be 
found by summing the link lengths and joint offsets starting at the fixed base 
as shown in Figure A-l: 

3 

Rj = *Sll*l + <*12 0 12 + ^>22*2 + * ' * + Sjj8j = 5 n *i + 5Z( a (l-l)i®(I-l)f + &U 9 l) 

1=2 

(A-l .3) 


A-2 The first order influence coefficient 


A-2.1 The rotational first-order influence coefficient 

The angular velocity of link jk of a serial manipulator is given as the 
sum of the relative angular velocities between preceding links in the serial ma- 
nipulator, 

(A— 2.4) 


(01) I (12) , 

“jk = “>12 + “>23 + 




or 


(A-2. 5) 


Ujk — 01*1 + 02*2 + * • • + 0j8j — ^2 0 n *j- 

n=l 

Then the above equation can be represented 

u* = [G jk ](f> (A-2.6) 

where the rotational first-order influence coefficients for link jk are defined as 

(A— 2.7) 


[<?‘l = 1^, ^-1 = bi\ at at\ 


d(j>\ d<j> 2 d<f>s 

and <j> n , the nth component of the generalized velocity vector, is either 0 n or 
s n depending on whether joint n is a revolute or a prismatic joint. The above 
results can be summarized as follows; 

. — revolute 


r r jk, _ jk _ / * n. n<j,n- 
l <t> i;n 9 n | 0, otherwise. 


(A-2. 8) 
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A— 2.2 The translational first-order influence coefficient 


Using the equations (A-1.2) and (A-1.3), the absolute position of the 
point can be written 

P = S li 8 1 + + S„ Sl ) + [Ri]P U) . (A-2.9) 

1-2 

By direct difFerention with respect to time, we get 

P = S\ lSl 4- + Sail + S,8 t ) + -£([/$P (i) ). (A-2.10) 

1=2 at 

Now, since and St are unit vectors fixed in link (/ — 1)/ and [Rl]P^ is a 

vector fixed in link the time rate of change of these vectors can be expressed 
in terms of the vector cross product as 

i - 1 

x «(/— i)/ = (53 ^n^n) x (A-2.11) 

n = l 


and 


/- 1 

Si = x Sj = 0„s n ) x St (A-2.12) 

n= 1 


4([B;]P 01 ) = X ([fli]P«) = (£ x ([PJ]P«>). (A— 2-13) 

at n=l 

Substituting equations (A-2.ll-A-2.13) into equation (A-2.10) and regrouping 
terms leads to 

P = + 0 n s n x [ ^2 (a(/-i)/d(;-i)/ + Suit + S/S/) -f [Rl)P^} 

n = l l=n + 1 

= £{Sn^ + ^ n x(P-P n )} (A-2.14) 

n=l 

where the term, 


y; + 5';S|) + [i?^]P^* — P — Hn, 

{ =z n *+■ 1 


(A-2.15) 
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represents a vector from the origin of the nth body-fixed coordinates to the 
point P. Finally, the velocity of point P can be expressed in the following form 

P ~ = [9ii 9*1 • • • >ff5v] (A-2.16) 


where 


[GIU = 9 P n 


s„ x (P — R„), n < j] <f> n = 9 n (revolute) 

< *n, n < j]<f>„ = S "(prismatic) 

,0, n > j. 


(A-2.17) 


A— 3 The second-order influence coefflcient 


A-3.1 The rotational second-order influence coefficient 


The angular acceleration of link jk, ctj k , is obtained by differentiating 
equation (A-2.6) 

+ [Gf]4>. (A— 3.18) 

To find the first term, differentiate the expression for the nth component of [G^\ 
given in equation (A-2.7) 


—( a i k ) _ / *'»> n < J; n ~ revolute 
di n [0, otherwise. 


(A-3.19) 


The controlhng input dynamics can again be decoupled from the geometric 
parameters by defining the rotational second-order influence coefficients in the 
form 

[tf&kn = (A-3.20) 

or 

[H&Un = (A-3.21) 
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The m; n subscript indicates the components of the mth row and nth column 
of the [H^\ which are vectors. And the angular acceleration of link j k, can be 
expressed 

<*jt = 4> T [H£]4> + [Gj*]*. (A-3.22) 

The rotational second-order influence coefficients can be obtained as 


[tf&w = k*. = 


a m x * n , m < n < j\m,n — revolutes 


0, 


otherwise. 


(A-3.23) 


A-3.2 The translational second-order influence coefficient 


Analogously, by differentiating the equation (A-2.16) with respect to 
time, the translational acceleration, a p , of a point, P, are written in the following 
form to decouple the geometric parameters from the control inputs 


«p=* TO* +[<?$]* 


(A-3.24) 


where the translational second-order influence coefficients are defined as 


[HUUr* ~ g^{ dt (9 P n )} 


(A-3.25) 


or 


TOW = gj-to'). 


(A-3.26) 

And these translational second-order influence coefficients can be obtained as 
follows 

f X [.„ X (P - Bn)], m < n < j\m,n — revolute 

8 n x [s m x (P — Hm)], n < m < j\m,n — revolute 

8 n x s m , n < m < j, m — prismatic, n — revolute 

s m x s n , m < n < j, m — revolute , n — prismatic 

[ 0, otherwise. 

(A-3.27) 


= h^ n = 


The obtained expressions for the kinematic influence coefficients of the 
serial manipulator are summarized in Table A-l. 
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A-4 Modeling of dynamic equations of serial manipulators 

The kinetic energy of a rigid link manipulator in motion can be ex- 
pressed as the sum of the kinetic energies of the individual links in the following 
form 

K.E. = J2 \{ M ikV T ci v C} + wj k [n jk ]w jk } (A-4. 28) 

j=i z 

where Mj k denotes the mass of link jk and the subscript cj denotes the mass 
centroid of the link. The [11,*] denotes the inertia tensor about centroid for 
link jk in terms of the fixed reference coordinates. Let the inertia tensor about 
the centroid defined in terms of the body-fixed coordinate systems be denoted 
by [11$], which is a constant symmetric matrix for each link. Noting that the 
kinetic energy is independent of the coordinate systems, that is, using 

[nJiVS* (A-4. 29) 

and 

u jk = [Rl}u%\ (A-4. 30) 

the following relation can be obtained 

IHji] = [fli][nSi ) ][fli] r . (A— 4.31) 

Equation (A-4. 28) can be rewritten in terms of first-order kinematic influence 
coefficients and controlling input velocities as follows 

K.E. = + 

Z J=1 Z 

(A-4. 32) 

where each components of the effective inertia tensor, [7J^], can be obtained 

+ sjfpijjrf*}. ( A-4.33) 

J= 1 
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It can be noted that from this equation, the effective inertia matrix is a function 
of geometric parameters and is a real symmetric matrix( positive definite matrix). 

Now using Lagrange’s equations of motion, the generalized inertia torque 
at the nth input(joint) can be written 


T = d ( dK - E ) _ <>Ml 
" dt K d<f> n } d<t> n 


(A-4.34) 


or 


r n = j t {iJ \r H U) - 


(A-4.35) 


where [7^]. n represents column n of the effective inertia matrix. Since 

J t ^ T \I- U ], n) = 0 T [^];n + 4> T ^([IUU 


dt' 


(A-4.36) 


where 


^j([^];n) — ^2 ^([7^);n)<£> (A-4.37) 


using equations (A-4.34- A-4.37) gives the generalized inertia torque at actuator 
n as 


n = Fvu » + + w.m 

(A-4.38) 

where the components of the inertia power matrix, [P n ], are defined by 

[/>„],» = - ^([/«];«). (A-4.39) 

To reduce the computational burden, an alternative matrix [P*], which is a 
symmetric matrix, can be used in the final dynamic equation using 




(A-4.40) 
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Then 

n = tfVUln + i T [P'M ( A-4.41 ) 

where the scalar component in row / and column m of the inertia power modeling 
matrix [P*] can be expressed in terms of the first and second-order influence 
coefficients as 

Kite = Zim«^Las + WilLfe]®? + X si,*)}. 
i=l 

(A-4.42) 

Finally the controlling equations of serial manipulators can be expressed 
in following form 

Ta = [rj4> + 4> T \P; m ]^ + T 3 + T l (A-4.43) 

where T a denotes the actuator input torque, T g and Tj, denotes the effective 
gravitational torque at joints and the effective external load at joints, respec- 
tively. However, in the above equation, the effects of the springs and viscous 
frictions are not included for convenience. 

A-5 Operational space dynamic formulation via transfer of coordi- 
nates 

In the previous section, the general dynamic equations in joint variables 
are derived. In this section, the dynamic equation in control point(such as 
end-effector or tool point) variables will be derived via transfer of coordinates 
technique. Detailed derivations can be found in [32]. 

Here, the universal generalized coordinates are denoted by 

U = («!, U 2 ,. .. , U M ) T 


(A-5. 44) 
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and the joint variables by 


4> = (<t> 1, <f> 2 , •••, <I>n) t ■ 


(A-5.45) 


The first and second-order kinematic relations between them can be expressed 
as 

« = (A-5.46) 

and 

u = (g;]0 + /[TO*. (A-5.47) 

or 

4> = IGtltt (A-5.48) 

and 

0 = [Gi]u + u T [H* u ]ii. (A-5.49) 

From equations (A-5.46) and (A-5.48), 

[Gt) = [G;}-\ (A-5.50) 


and using equations (A-5.46- A-5.49), 

* = [Gtl* - * T [Gif ([Gi] • TODM* = [Gil* + * T (0- (A-5.51) 

That is, 

[ffM = -[Gi] T ([Gi] . [/%] )[Gi). (A-5.52) 

The operation • (called generalized dot product) is defined as followings when 
[A] = P x K and [B] = K x M x N ; 

([A] • [-B] ) p; m;n = X^([A]p;fc(5]fc ;m;n ). 
k=l 


(A-5.53) 
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The dynamic equations in joint and in control point variables can be 
written, respectively, 

= IW + <t> T [PUM (A-5.54) 

and 

n = [/* u ]« + u T [P^ u ]u. (A-5.55) 

Since kinetic energy is independent of the coordinate systems, 

KE. = i (A— 5.56) 

using equation (A-5.46), the relation can be found 

id = [G;]- T (d)[ G ;r I - (a— 5.57) 

From the virtual work principle, we have 

n = (G>] T n. (A-5.58) 

By inserting equations (A-5.54), (A-5.55), and (A-5.57) into the above equa- 
tion, one can find 

= \G' t r T {({air 7 . [/>;«]) - ((/;j . [/fy)}[G;]-'. (A-5.59) 

A— 6 Kinematic/ dynamic modeling of multi-loop parallel mechanisms 

The dynamic formulation, which is presented in previous section, can 
be applied to the parallel mechanism in which the degrees of freedom of each 
subchain are the same as the degrees-of-freedom of the outputs of the system. 
The dynamic equation for a parallel system which has R serial subchains of 
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n dofs motion, can be obtained. First, from the each serial chain, the kine- 
matic and dynamic parameters are developed, treating every joint variable as 
independent, that is 

I'CJ], r«W TO, r TO, /» r r= 1,2 (A-6.60) 

To obtain the kinematic parameters for the desired generalized variables 
(i.e., actuated joints or <f > a ) such as [GJJJ and the kinematic relations, 

which satisfy the geometric constraints imposed by the parallel system, can be 
used. For the first-order kinematic influence coefficients, noting 

« = [ r G>W> r, /or r = 1,2, . . . , f2, (A-6.61) 

one can find 

<t>r = /or r = 1,2,.. . (A-6.62) 

where 4> r represent the joint variables of the rth serial subchain of the multi-loop 
parallel system. Then the kinematic equations for the desired variables can be 
obtained by selecting the corresponding equations from the above equations and 
writing in matrix form. 

<t> a = [ G 2J -1 “ (A-6.63) 

where [Gjj is obtained by taking the inverse of 

For the second-order kinematic influence coefficients, each serial sub- 
chain yields the following equations: 

u = [ T Gl\4> r + ^ r T [ r tf;^ r for r = 1,2, . . . , R. (A-6.64) 

Next, using equation (A— 5.48) and (A— 5.52), one can find 

4> r = [ r G*]u + ii T [ r Ht]u for r = 1,2,. . . , R. (A-6.65) 
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The second-order kinematic equations for the desired variables can be obtained 
by selecting the equations corresponding to the desired independent variables 
(input joints) from the above equations and writing in these matrix form. 

= PM* + (A— 6-66) 

Note that the J array can be obtained using equation (A-5.52) with ap- 
propriate substitutions. 

For the dynamic parameters in terms of the operational variables for 
the parallel system, by combining the effects of each subchain and including the 
centroidally referenced inertial effects of the platform if any ([J utl ] and [P ullu ]), 
one can find obtain the following equivalent mass expressions 

Id = Id] + Erd (A-6.67) 

r=l 

Id..] = [a..] + £['dj- (A-6.6S) 

r=l 

Finally, the mass coefficient description in terms of the driving input variables 
can be obtained as below, by inserting corresponding variables into (A-5.57) 
and (A-5.59); 

IdJ = IGj-rHClK-]- 1 (A-6.69) 

id*, j = kt t ((K-]- t . id.]) - ([/;.♦.] • WiDiiGS-r 1 - (A-6.70) 




APPENDIX B 


Kinematic Transformations of the Universal Teleoperator System 


When the universal manual controller is applied in a teleoperation sys- 
tem, geometric differences between the manual controller and the remote manip- 
ulator need to be bridged by performing adequate transformations and scalings. 
In this section, various kinematic mappings between the manual controller and 
the remote manipulator are reviewed [64], and one method of the scaling of the 
rotation will be presented. Note that as opposed to translational scaling, rota- 
tional scaling has restrictions since finite rotational displacements do not have 
the properties of vectors. 

The rotation of the body can be represented as a rotational matrix, 
in equivalent Euler angles, or in an equivalent single axis rotation. The direct 
application of the rotational gains to the Euler angles does not seem to be 
appropriate for the human operator, since for large angular displacements with 
scaling, the corresponding angular motions between the manual controller and 
the remote manipulator may be confusing. Also, recursive mapping in which the 
mapping is based on the current local or global reference frame, is not considered 
here due to its noncyclic property. In the scaling of the rotation of the body, 
the rotational angle about the equivalent rotation axis will be applied to the 
kinematic mapping for teleoperator systems. This method does provide cyclic 
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properties so that when the manual controller is at the initial orientation, the 
remote manipulator stays at its initial orientation. 


B-l 


Kinematic transformations of the universal teleoperator system 


A rotation matrix [R^\ represents the direction cosines of frame B with 
respect to frame A, in other words, an operator which transforms the orientation 
of frame A to the orientation of frame B. It is a linear transformation operator 
for which the transformed vectors preserve their lengths and angles. That is, 
\[Ra] x \ = 1*1 and cos([i?f]x,[i?f]y) =cos(x,y) for any arbitrary vectors, x and 
y. Let arbitrary vectors (x^) be in frame B and (x^) be in frame A. The linear 
transformation operator(or orthogonal tensor in this case) which transforms any 
arbitrary vector in frame A into the vector in frame B, can be obtained by 
imposing the following condition; 


That is, noting 


and 


one finds 


H 

II 

» 

(B— 1.1) 

O'**. 

II 

H 

(B-1.2) 

H 

II 

Is 

^t3D 

H 

(B-l. 3) 


(B— 1.4) 

x'a 1 = 

(B— 1.5) 


(B-l .6) 


As shown in equation (B-l. 3) and (B-l. 6), the operators, [R^\ and [iJoJfiJj], 
denote the local mapping tensor and the global mapping tensor, respectively. In 
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the following, based on these two mapping tensors, four basic mappings will be 
presented for teleoperator system kinematics. 

Let the current local reference frames of the manual controller and 
the remote manipulator be A and A’, respectively, and O represents the global 
reference frame as shown in Figure B-l. Also A and A’ represent the local 
reference frames which could be either in an initial position or in a redefined local 
position accomplished by re-referencing. These reference frames are redefined 
whenever the re-referencings in teleoperation are made. The direction cosine 
of those two local frames with respect to the global frame can be represented 
by [. Rq ] and \Rq\, respectively. Let the absolute position of the origin of the 
local frames of the manual controller and the remote manipulator be denoted 
by To a and toa'i respectively. The local position vectors from A to B and 
from A’ to B’ in corresponding local reference frames will be denoted by t^b 
and respectively, where B and B’ represent the next local frames of the 

manual controller and the remote manipulator, respectively. 

The four basic mappings between the manual controller and the re- 
mote manipulator are examined. These are the local- to- local, local-to-global, 
global- to- local, and global-to-global mappings. For each mapping, the required 
transform will be presented briefly. 

B-l.l Local-to-local mapping 

In this mapping, the required conditions for the rotation matrix and 
position are 

[R%] = [Ra'i] for rotation (B-l. 7) 
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and 

= r^,g, for translation. (B-1.8) 

The remote manipulator’s global rotation matrix at B, can be found using equa- 
tion (B-1.7) as follows 

1 = [<]«■] = [RoIRaV (B-i.9) 

The global position at B’ of the remote manipulator can be obtained using 
equation (B-1.5) and (B-1.8). Noting 

tob = toa + tab, (B-1.10) 

then, 

TOB' = I’OA 1 + f'A'B' — r OA' + [R& ] r ^A'B' = r OA' + [#0 ]\^- C a\ t AB- (B— 1.11) 

B— 1.2 Local-to-global mapping 

In this mapping, the imposed mapping conditions can be written by 

for rotation (B-1.12) 

= r a'b' for translation. (B-1.13) 

The remote manipulator’s global rotation matrix at B can be found as 
follows using equation (B-1.12), 

[Rg] = [R B d\[R°A']{Ro\ = [R b a)[RZX (B— 1-14) 

The global position at B’ of the remote manipulator can be obtained using 
equation (B-1.13) and (B-1.5). Noting 


tob — toa + tab, 


(B-1.15) 
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then, 

tob' = roA 1 + r A'B' = t oa' + r ^ = ToA' + [^2Wb- (B-1.16) 

B-1.3 Global- to-local mapping 

In this mapping, the mapping conditions can be written by 

[Ro\\$a\ — [R%] f or rotation (B-1.17) 

r A B = r A>B’ Z 07 ” translation. (B-1.18) 

The remote manipulator’s global rotation matrix at B, can be found using equa- 
tion (B-1.17), 

IKS'] = I #][*?] = lift)! (B— 1.19) 

The global position at B’ can be obtained using equation (B-1.5) and (B-1.18) 

tob — roA + r AB (B-1.20) 

roB' = r OA' + r A’B' = r OA' + [ R-o ] r !^2» = r OA' + [#0 ] r AB- (B-1.21) 

B-1.4 Global-to-global mapping 

In this mapping, the mapping conditions are written by 

[Ro][Ra] = [Ro)\R%] f<* rotation (B-1.22) 

tab — rA'B' for translation. (B-1.23) 

The remote manipulator’s global rotation matrix at B’, can be found using 
equation (B-1.22), 


[Ro\ = (flo][^.)][Ho] = [*g][*2][*3']- 


(B-1.24) 
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The global position at B’ of the remote manipulator can be obtained using 
equation (B-1.23). Noting 

TOB = f'OA + r ABt (B-1.25) 


then 


TqB’ ~ r OA’ + r A'B ' ~ TOA' + r AB- 


(B-1.26) 


B-1.5 Kinematic scaling 


For the translational motion, scaling can be made by post multiplying 
the constant gain matrix, [ g p ], in mapping conditions as shown in Table B-2. 
The scaling matrix can be defined by 




a 0 0 

0 6 0 . 

0 0c 


(B-1.27) 


However, the scalings for the rotational motion require more consider- 
ation. Among other cases, in this section, scaling of the rotational motion will 
be based on the equivalent rotational displacements about the equivalent axis, 
which can represent the general rotational motion of the body in space. Once 
equivalent axis (lb) and its angular displacement (<Pab) are obtained, they can be 
applied to the scaling(g r ) for rotational motion in teleoperation. For example, 
the transform matrix, can be substituted by [Rot(k, g r <i>AB)\- 

In summary, implications for each mapping are given in Table B-l and 
the results of the scaling on the rotational motion are shown in Table B-2. 
Note that as can be seen from the Table B— 2, local and global mappings can 

In Table, when </ r ^ 1, [R%] and [rtg][«°] are replaced by the cooresponding 

[Rot(k, Qr <t>AB )] ■ 
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be performed by post-multiplication and pre-multiplication of the correspond- 
ing transform tensors to the current orientation of the system. Note that the 
kinematic mapping from the remote manipulator to the manual controller can 
be made by exchanging the corresponding parameters; A <-> A\ and B «-+ B\ 
In the next section, the procedure for finding the equivalent rotation axis and 
its equivalent rotation is provided briefly for reference. [75] 


Table B-l Four basic kinematic mapping conditions 


local-to-local mapping 

= [R%] for rotation 
[?p] r ab = r !^B' for translation 

local-toglobal mapping 

[R-a] — [*g*][J&] for rotation 
bp] r AB = r A‘B‘ for translation 

global-to-local mapping 

[RoWR^a] = [Ra‘\ for rotation 
\g p ]r ab = f° r translation 

global-to-global mapping 

[Rv\[R%\ = [R$][R%'\ f° r rotation 
\9v\ r AB = Ta'B 1 for translation 


Table B-2 Summary of the kinematic mapping 



rotational mapping 

translational mapping 

local-to-local 

WRWr 

Tob> = r 0 A' + [Ro][R%][9v]rAB 

local-to-globed 

wi = wmz\ 1 

TOB • = *OA' + 

wmszmm 

global-to-local 

WRMIPUMT 


msmxami 

local-to-local 


TOB' — To A 1 + 

\9p]tab ii 


B-l .6 General rotation transformation of the body in space 

Any combination of rotations of the body in space can be represented 
by a single rotation about some axis k by an angle <f>. The followings describes 
a procedure of finding the equivalent rotation axis, lb, and the rotation angle, <f>, 
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given a rotational transform matrix of the body, and its results (adapted from 
[75]). 

The transformation matrix representing a rotation around an arbitrary 
vector k located at its origin can be represented by 


[Rot(k, <!>)}= 


k x k x (l — c<f>) + c<i> 
k x k y ( 1 - c<j>) + k z s<f> 
k x k z (l — c<p) — k y s<t> 


kyk x {\ c</i) k z C(p k x k x {^\ ci/i) kyS(f) 

kyky(l ~ C<}>) + C<t> k;ky( 1 ~ C(f>) ~ k ; S <j> 

kyk z (l - C(f>) + k x s<f> k z k z (l - c<j>) + c<p 

(B-1.28) 


where k = ( k x , k y , k z ) T is a global vector. Given a rotational transform matrix 




Tig 

o x 

a. 

n y 

°v 

a \ 

n z 

O z 

a 


(B-1.29) 


By equating the equation (B-1.28) and (B-1.29) with some manipulation, the 


following results can be obtained 


tan <f> = 


^/(og - a v ) 2 + (a r - n z ) 2 + (riy -^Qj ) 2 
(n x + o v + a z - 1) 


(B-1.30) 


and 


k x — 


Qx ~ <h 
2 sin <p 


v 2 sin 4> 
k = n y -o x 


2 sin 4> 


(B-1.31) 

(B-1.32) 

(B-1.33) 


When the resulting rotation angle is small, the vector k should be normalized 
to ensure The resulting solution is effective when the rotation angle, </>, 


is within 0° < 4> < 150°. But, when <f> — 180°, equations (B 1.31) to (B 1.33) 
becomes 0/0. Therefore if the rotation angle is greater than 90°, the following 
results and procedures are recommended; 
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• find the largest component of k in following expressions 


k x = sgn(o z - a v )^ 

fn x — cos <f> 
/ 1 — cos <f> 

(B-1.34) 

k y = sgn(a x - n z ) 1 

ja y — cos <f> 
y 1 — cos <t> 

(B-1.35) 

k z = sgn(n v - o x )^ 

ja z — cos <f> 
y 1 — cos <j> 

(B-1.36) 


where sgn(e) = 1 if e > 0 and sgn(e) = -1 if e < 0. 


• if k x is the largest, then 


k = — — 

v 2k x (l — cos <f>) 

k - Q * + n » 

1 2k x {\ — cos^)’ 

if k y is the largest, then 


k = — — 

x 2k y {\ — cos <f>) 


K = 


o z + a. 


2fc v (l — cos<£)’ 


if k z is the largest, then 


k = — + w » 

x 2k z (l — c6s<j>) 

k - + a v 

v 2A:^( 1 — cos <f>) 

For more detailed discussion can be found in [37][75][100]. 


(B-1.37) 

(B-1.38) 

(B-1.39) 

(B-1.40) 

(B— 1.41 ) 


(B-1.42) 
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Hardware and Software for the Shoulder System 
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C-l Listings of hardware/software for shoulder system 


Table C— 1 Listings on the hardware/software for shoulder system 


Contents 
Servo-disk Motor 
Tachometer (analog) 
Incremental Encoder 
Incremental Encoder 
Harmonic Drive 

PWM Amplifier 

Transformer 
Parallel Interface Board 
Lord Force/ Torque S ensor 
5 Volts Voltage Source 
A/D Board 
D/A Board 
Encoder’s Counter IC 
Shoulder Construction 
Shoulder Supporting Frame 
Handgriper 

F/T sensor Mounting Device 
Encoder’s Counter Circuit 

DRVll-J Driver 

Lord F/T Sensor Driver 

Control Software for Shoulder 


Model ID 

S6M4H 

S6T 

M23( 1000- ABI-5-S-C) 

M23(2540-ABI-5-S-C) 

H6D-60 

VXA 48-8-16 

T-26-16 

DRVll-J 

FT 15/50 

ADV11-C 

AAV11-C 

HCTL-2016 


in Fortran 
in Fortran 
in Fortran 


Units 

3 

3 

3 

1 

3 

3 

1 

2 

1 

1 

1 

3 
8 
1 
1 
1 
1 

4 


Company 

PMI 

PMI 

PMI 

PMI 

PMI 

PMI 

PMI 

DEC 

Lord 


DEC 

DEC 

HP 

UT 

UT 

UT 

UT 

UT 

UT 

UT 

UT 
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C-2 Actuator system components specifications 

• Pulses of channel A and B has more than 90 degree phase difference, and 
pulses of Index channel, I, is generated for every revolution. 


• Conversion factor of the encoders can be obtained as follows; 


Af m r — 


27T 


4 N^N 


{rad/ count) 


or 


K = 
enc 4 N cpr N 


(deg j count). 
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Table C-2 Actuator system components specifications I 


| S6M4H Servo- Disk Motor 

Peak Torque T p 

1 86oz — in 

Continuous Stall Torque T, 


Peak Current I p 

46amps 

Continuous Stall Current I s 

4.2 amps 1 

Rated Torque T r 


Rated Speed N r 

3000rpm j 

Torque Constant Kx 


Back EMF Constant Kf, 

3.00 volts / krpm 

Terminal Resistance Rx 

1.32ohm 

Armature Resistance R a 

0.940ohm 

Friction Torque Tj 

0.90oz — in 

Viscous Damping Coefficient K vd 

0.16 oz — in/ krpm 

Mass Moment of Inertia J m 

8.510“ 4 o2 — in — sec 2 

Armature Inductance L a 

less than 100 microHenry 

Meehan* ceil Time Constant T m 

6.8msec 

Electrical Time Constant T e 

0.11msec 

Operating current 


Operating voltate 

V = T^ + RtI 

S6T Analog Tachometer 

Output Voltage K tac h 

0.75 volts/ krpm 

Mass Moment of Inertia Jtach 


1 M23 Modular Incremental Encoder 

TTL Compatible 

5 volts operation 

Quadrature and Index Channels 

A,B> and I 

Frequency Response 

100 KHz 

Mass Moment of Inertia J enc 

0.00025O2 — in — sec 2 

Encoder’s Counter Resolution 

16 bit 
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Table C-3 Actuator system components specifications II 


Encoder Conversion Factors 

Encoders on base actuated joints 

Number of cycles per revolution 

1000 

Counts per cycle of HCTL-2016 IC 

4 

Conversion factor(rad/counts) K enc 

0.00002618 

Conversion factor(deg/counts) K enc 

0.0015 

Encoder on the to 

p ternary joint 

Number of cycles per revolution Ncp r 

2540 

Counts per cycle of HCTL-2016 IC 

4 

Conversion factor(rad/counts) K enc 

0.0006184 

Conversion factor(deg/counts) K enc 

0.03543 

Harmonic Drive Reducer(HDC-3C) 

Gear Ratio N 

60 to 1 

Wave Generator Inertia I u .g 

0.00015/6 — in — sec 2 

Friction input torque T cwq 

2.5 oz — in 

S6M4H/HD-60 

Mass Moment of Inertia J mh 0.7425 lb — in — sec 2 ~ r 

S6M4H/HD60/S6T/M23 

Mass Moment of Inertia J m wg 

0.855/6 — in — sec 2 

Friction Toruqe T c 

12.75/6 — in 

PWM Amplifier(VXA-48-8-16) 

Switching frequency 

> 20 KHz 

Bandwidth 

500 Hz 

Operational options 

velocity mode and current mode 

Maximum current output capacity 

8 amps continuous 


16 amps peak current output 

PWM Transformer(T-26-16) 

Transformer continuous 26 volts and 16 amps. 
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ADV11-C Analog Input Board 


Identification A8000 " ~ 


Current configuration 16 single-ended channels 


Input range -10 to 10 volts;2’s complement coding 

Resolution ^2- bit. “ 


AAV11-C Analog Output Board 


Identification A6006 ~ 


Current configuration I Bipolar output, 4 channels 


Output range 10 to 10 Volts 


Resolution [ 12-bit. ~ “ 


DRV11-J Parallel Interface Board 


Identification M8049 


Device address 764 160 (encoder), 764140(F/T sensor) 

Resolution 16-bit “ 


Lord 15/50 F/T Sensor 


Maximum fo rce/torque capacity 15/6/50m - /ft 


Fx, Fy = 0.174 oz; Fz = 0.57 6oz 


Tx y Ty,Tz = 0.391m — oz 


serial(ASCII or binary resolved data) 


parallel(strain gauge raw data) 


Sampling time for F/T 15/50 sensor data 


Raw data via parallel port | 440ifz(2.27msec) ~~ — — 


Conv. into resol. data in /*V AX II 2.6msec 


Resol. data via. serial port | 100//z(10.msec) 


Force resolution 


Torque resolution 


Communication 
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C-4 A F/T sensor interface 

The Lord F/T processor uses a Motorola MC-68B21 Peripherial Inter- 
face Adapter(PIA) for the parallel port. Through this port, strain gauge raw 
data are transmitted and transmission is record- oriented, where one record rep- 
resents a complete set of eight strain gauge data. Interfacing MC-68B21 PIA in 
the F/T sensor to the DRV11-J parallel interface board in the micro VAX II, is 
presented briefly. However, this outline provides the sufficient information for 
actual implementation. 

First, transmission of each record is initiated by enabling DRV11-J 
RDY signal, which occurs when the DRVll-J is set as an input device. The 
DATA READY handshake line is enabled indicating to the DRVll-J that the 
next word is on 16-bit data bus. When the DRVll-J sees DATA READY signal 
high, it reads the word and replies by enabling the DRVll-J RPLY line. Note 
that since the DRVll-J is based on negative logic, the DATA READY and 
DRVll-J RPLY signals are inverted. After receiving a record, the DRVll-J is 
set as an output device. This causes the DRVll-J RDY signal to go high. This 
step is necessary for the next record since handshake lines are based on high-to- 
low transitions (edge triggered). For quick reference, the interface diagram and 
the relative signal timings of the two I/O devices are shown in Figure C-l and 
Figure C-2. More details could be found in [22] [53]. 
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DRV 1 1-J Parallel Interface 
Board Pin Assignments 


i Kmw 



Lord F/T sensor 

Parallel Port Connector Pin Assignments 


1 DATA BIT 7 


2 DATA BIT 6 

3 DATA BIT 5 

4 DATA BIT 4 

5 DATA BIT 3 

6 DATA BIT 2 

7 DATA BIT 1 

8 DATA BIT O(LSB) 

9 DATA BIT15 (MSB) 

10 DATA BIT 14 

11 DATA BIT 13 

12 DATA Brr 12 

13 DATA BIT 1 1 

14 data Brr 10 


LS7404 IC is 
used as inverter 


. uaui » 


is data Brr 9 

16 data Brr 8 

17 SYSTEM HEALTH PORT #1 
EMITTER 

18 SYSTEM HEALTH PORT #2 
EMITTER 

19 DATA READY HANDSHAKE 

20 DATA RECEIVED HANDSHAKE 

21 START HANDSHAKE 

22 - 32 GND 
33-34 +5 VOLTS 

35 SYSTEM HEALTH PORT #2 
COLLECTOR 

36 SYSTEM HEALTH PORT #1 
COLLECTOR 


Figure C-l Physical connections between DRV11-J and Lord F/T sensor 
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F/T Processor 


Start 



DRV 1 1-J 
DRV 11 -J RDY 


DATA 

READY 


DATA 

RECEIVED 


16-bit 
Data Bus 


fflumnnn. 



User RPLY 


DRV 1 1-J 
RPLY 


DRV 1 1-J I/O 
< 1 5:0> 


One record 

(eight strain gauge raw data) 


Next record 


Figure C-2 Signal timing between the DRV11-J and the F/T processor 


C-5 Hardware interfaces 


C— 5.1 Encoder interface diagram 
C— 5.2 Hardware connection diagram 
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DRV 1 1 -J Register B 



* For remaining 16-Bit data connections, refer to table C-5 

* R = 330 ohms, C = 0.01 micro-farad, 5 MHz Crystal 

* 5 Volts external power supply is required 


Figure C-3 Encoder’s counter IC/DRV11-J interface diagram 
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Table C-5 Pin connections between DRV11-J and HCTL-2016 IC 


DRV11-.J A or D 
37(bit 0) 

39 (bit 1) 

38(bit 2) 

40(bit 3) 

35 (bit 4) 

42( bit 5) 

36(bit 6) 

41 (bit 7) 

47(bit 8) 

50(bit 9) 

44 (bit 10) 

48 (bit 11) 

49 (bit 12) 

43(bit 13) 

46( bit 14) 

45(bit 15) 

29(DRV11 J RDY) 
33(DRV11J RPLY) 
26,28,30,32,34 


HCTL-2016 
D0(low byte) 

D1 

D2 

D3 

D4 

D5 

D6 

_D7 

D0(high byte) 
"Dl 
D2 
D3 
D4 
D5 
D6 

_D7 

OE ~ 

SEL(high byte) 
Vss 


DRVll-J B or C 
14 (bit 0) 

12(bit 1) 

13(bit 2) 

11 (bit 3) 

16(bit 4) 

9(bit 5) 

15(bit 6) 

10(bit 7) 

4 (bit 8) 

1 (bit 9) 

7 (bit 10) 

3 (bit 11) 

2(bit 12) 

8(bit 13) 

5 (bit 14) 

6(bit 15) 

20(DRV11J RDY) 
24(DRV11J RPLY) 


HCTL-2016 
DO (low byte) 

Dl 

D2 

D3 

D4 

D5 

D6 

JD7 

DO (high byte) 
"Dl 
D2 
D3 
D4 
D5 
D6 

D7 

OE ~ 

SEL(high byte) 


17,19,21,23,25 


Vss 
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PWM Amplifier 



( 1 ) 

( 2 ) 

( 3 ) 

( 4 ) 

( 5 ) 

( 6 ) 


( 1 ) 

( 2 ) 

( 3 ) 

( 4 ) 

( 5 ) 

( 6 ) 

( 7 ) 


Figure C-4 Actuator hardware system connection diagram 
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